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ABSTRACT 

The  es'tlBa'tion  of  launch  vehicle  performance  paraae1;ers 
was  explored  l^hrough  the  use  of  a  Bayes  Filter.  The  main 
emphasis  was  to  devise  the  means  to  detect  a  staging  event, 
estimate  the  staging  time  and  next  stage  vehicle  parameters, 
and  reenter  the  main  Bayes  Filter  to  process  subsequent  stage 
observation  data.  The  state  model  consisted  of  the  vehicle 
position  and  velocity  vectors,  the  exhaust  velocity , amd  the 
mass  ratio.  The  results  indicated  that  the  staging  event 
could',  successfully  be  detected  by  comparing  the  position  of 
the  vehicle  as  represented  by  the  observation  data  and  the 
position  as  represented  by  the  numerical  integrator.  The 
exhaust  velocity  and  mass  ratio  of  the  next  stage  could  not 
be  estimated  independently.  The  staging  estimater  state 
model  was  then  altered  to  estimate  the  product  of  the  exhaust 
velocity  and  mass  ratio.  The  problems  encountered  reentering 
the  main  Bayes  Filter  were  identical  to  the  ones  the  staging 
estimator  had.  It  was  then  determined  that  there  was  a  pos¬ 
sible  observability  problem  with  the  main  algorithm.  It  was 
recoomiended  that  the  main  state  vector  be  altered  to  include 
the  product  of  the  exhaust  velocity  and  mass  ratio  rather 
than  thier  independent  estimation. 


The  determination  of  launch  vehicle  performcuice  parame¬ 
ters  was  last  investigated  by  Capt.  Vallado  (reference  4) 
with  marginal  results.  The  difficulties  encountered  were 
a  result  of  a  staging  event  occurring  during  the  beginning 
or  middle  of  a  Bayes  Filter  (reference  5)  segment  amd  the 
dynamics  not  modeling  the  problem  adequately  once  the  staging 
event  occurred.  The  specific  task  that  will  be  examined  in 
this  research  will  be  an  attempt  to  "capture"  the  staging 
event  and  remodel  the  dynamics  once  the  staging  event  has 
been  detected  by  the  computer  algorithm.  The  importamce  of 
gaining  knowledge  of  foreign  technology,  as  stated  by  Capt. 
Vallado  (reference  4),  would  aid  the  United  States  in  plan¬ 
ning  strategic  defense  policies  and  determine  where  emphasis 
should  be  placed  for  future  research  and  development. 

The  problem  we  will  be  addressing  will  involve  the  de¬ 
tection  of  the  launch  of  a  missile  and  the  subsequent  track 
of  that  vehicle  by  either  an  orbiting  sensor  or  land  sensor. 
The  data  obtained  will  then  be  used  to  determine  the  launch 
vehicle  parameters  to  aid  in  identification  of  the  type  of 
vehicle  launched  or  the  classification  of  a  new  type  vehicle, 
as  the  case  may  be. 

Figure  1  shows  the  geometry  involved  in  the  problem  of 
a  land  based  sensor  tracking  the  vehicle.  In  "real  life" 
the  vehicle  will  not  be  tracked  until  it  appears  over  the 
horizon  or  in  the  field  of  view  of  the  sensor.  This,  in  all 


Figure  1 .  Laund  Based  Sensor  Geometry 

cases,  will  be  some  time  period  after  launch  has  occurred. 

For  this  paper  it  will  be  assumed  that  the  data  is  available 
fov  the  entire  trajectory  of  the  vehicle  and  its  point  of 
origin  is  known. 

Figure  2  shows  the  geometry  involved  in  the  problem  of 
an  orbiting  sensor  tracking  the  vehicle.  The  problems  asso¬ 
ciated  with  an  orbiting  sensor  is  that  it  must  identify  the 
vehicle  among  the  "ground  clutter"  as  it  is  looking  down  on 
the  launch  trajectory.  With  recent  developments  in  radar 
technology,  this  problem  is  becoming  less  of  a  concern.  The 
problem  being  investigated  could  be  readily  applied  to  recent 
developments  in  the  Strategic  Defense  Initiative.  The  detec¬ 
tion  and  subsequent  threat  assessment  of  a  launch  vehicle  of 


unknown  origin  is  invaluable. 


I'’if?ure  2. 


Orbiting  Sensor  Geometry 


Work  done  in  this  area  prior  to  Capt .  Vallado's  thesir. 
included  the  determination  of  position  and  velocity  vectors 
and  vehicle  acceleration  using  a  7 -state  filter  from  ele 
vation  and  azimuth  data  (reference  2).  Gapt .  Gross’s  thesis 
made  the  first  use  of  a  Bayes  Filter  to  determine  exhaust 
velocity,  vehicle  mass,  and  vehicle  acceleration.  This  re¬ 
sulted  in  good  results  for  vehicle  acceleration  and  poor 
results  for  exhaust  velocity  and  vehicle  mass.  As  was  point 


ed  out  by  Capt.  Vallado,  the  complexity  of  the  data  and  the 
observation  relationships  were  partly  responsible  for  the 
problems  encountered. 


EQOATIONS  OE  MOTION 


For  the  problem  being  investigated,  the  equations  of 
motion  must  be  developed.  The  Bayes  Filter  (reference  5) 
algorithm  will  use  the  numerical  integration  of  these  equa¬ 
tions  to  estimate  the  data  that  the  radar  sites  would  be  ob¬ 
serving.  In  developing  these  equations,  a  spherical  earth 
model  and  the  two-body  equations  of  motion  (reference  1)  are 
considered.  This  seems  to  be  a  reasonable  assumption  as  all 
trajectories  considered  will  be  "near  Earth”  types  and  all 
other  gravitational  force  considerations  will  be  small  in 
comparison. 

In  general,  the  two-body  equation  of  motion  is; 

r  +  r/i/r3  =  0  (2-1) 


where 

f  =  vehicle  acceleration 

r  =  radius  vector  from  center  of  Earth  to  vehicle 
r  =  radius  vector  magnitude 
H  =  gravitational  parameter  defined  by: 

^  =  GM  (2-2) 

where 

G  =  Universal  Gravitational  Constant 
M  =  Hass  of  the  Earth 

Only  gravitational  and  thrust  forces  are  considered  in  this 
paper  as  they  are  assumed  to  be  several  orders  of  magnitude 
larger  than  other  forces  that  could  be  present  (i.e.  drag. 


solar  radiation,  etc.). 


The  acceleration  due  to  thirust  can  be  derived  bjr  recall 
ing  the  equations  of  notion  of  the  rocket  (reference  6)  as 
illustrated  in  Figure  3.  By  following  the  expended  particle 


Figure  3.  Rocket  Thrust 

of  fuel,  the  equation  of  motion  of  the  rocket  can  be  devel¬ 
oped.  This  is  a  closed  syst^  of  particles,  and  therefore, 
must  conserve  linear  momentum.  To  start,  the  linear  momen¬ 
tum  is  mv,  where  m  is  the  mass  of  the  vehicle  and  v  is  the 
velocity  of  the  vehicle.  After  a  time  dt,  an  incremental 
particle  of  fuel  (dm)  is  expelled  by  the  rocket  at  a  velocity 
Ve  with  respect  to  the  rocket,  as  shown  in  Figure  3.  The 
incremental  particle  of  fuel  has  a  velocity  of  Ve  +  v  with 
respect  to  the  inertial  frame.  The  rocket  has  lost  mass  dm 
(interpreted  as  a  negative  quantity)  but  has  gained  velocity 
dv.  Therefore,  the  conservation  of  momentum  can  be  expressed 
as: 


(m  +  dm)  (v  +  dv)  -  dm  (v  +  Ve ) 


mv 


(2-3) 


Expanding  Equa'bion  (2-3)  and  neglecting  higher  order  tens: 

mdv  -  dmVe  =  0  (2-4) 

Dividing  Equation  (2-4)  by  dt  and  taking  the  limit  leaves: 

m  Ve  =  m  athrust  (2-5) 

where 

Ve  =  exhaust  velocity 
fflVe  =  thrust 

Noting  that  the  instantaneous  mass  ten  (m)  can  be  written 
to  reflect  changing  value  with  respect  to  time.  Equation  (2- 
5)  can  be  rewritten  in  the  direction  of  the  velocity  vector 
as: 

m  Ve  y 

athrust  =  "  -  (2-6) 

(mo-  mt)  |v| 

where 

^thrust  =  vehicle  acceleration  due  to  thrust  along  the 
velocity  vector 
m  =  mass  flow  rate 
mo  =  initial  mass 
t  =  time 

Ve  =  Vehicle  exhaust  velocity 
This  particular  equation  is  sufficient  if  the  problem  in¬ 
volved  singly-staged  vehicles  only,  as  presented  in  Capt. 
Vallado’s  thesis  (reference  4).  In  order  to  present  the 
problem  in  a  more  general  form,  it  must  be  modified  to  allow 
for  multi-staged  vehicles.  Therefore,  Equation  (2-6)  must  be 
rewritten  as  follows: 


) 


[mo  -  m  (t  -  talmee)] 


V 


I 


r 
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where 

tatatfe  =  the  time  the  staging  event  takes  place 

Since  the  absolute  masses  are  not  observable  from  the  tra¬ 
jectory  data,  let  M  =  m  /  mo ,  and: 

Ve  M  V 

a  =  —  —  '  -  •  I  (2-8) 

[1  -  M(t  -  tatage)]  |vl 


By  recalling  Newton’s  Law  (the  mass  times  acceleration  equals 
the  sum  of  the  forces),  the  total  vehicle  acceleration  is 
obtained  by  combining  Equations  (2-1)  and  (2-8)  as  follows: 


r  H 

Ve  M 

V 

r3 

[1  -  M(t  -  tetage)] 

V 

where  r  denotes  the  total  vehicle  acceleration. 


Observation  Relationships 

Two  cases  were  considered  while  developing  this  algo¬ 
rithm.  The  first  case  was  of  an  orbiting  sensor  observing  a 
launch  vehicle  trajectory  from  above.  The  next  case  involv¬ 
ed  a  ground  radar  site  tracking  a  launch  vehicle  above  the 
horizon.  The  observation  relationships  for  both  cases  are 
the  same  with  the  exception  of  the  position  vectors  of  the 
radar  sites. 


The  position  vector  of  the  ground  radar  site  can  be  de- 


ternined  once  'the  la'titude,  longi-bude,  elevation,  and  uni¬ 
versal  time  are  known.  For  these  values  we  begin  by  calcu¬ 
lating  the  local  sidereal  time  for  the  site  (reference  1): 


e 


+  Xe 


(2-10) 


W 


where 

6  =  local  sidereal  time  in  degrees 

Be  =  Greenwich  sidereal  time  in  degrees 
Xe  =  longitude  of  the  site  in  degrees 

The  Greenwich  sidereal  time  is  calculated  as  follows: 


Be  =  Beo  +  1.0027379093  (  t  -  to  )  2  Tf  (2-11) 


where 

Be  -  Greenwich  sidereal  time  in  degrees 
Beo  =  value  in  degrees  on  1  Jan  that  year 
(  t  -  to  )  =  time  in  days  past  initial  time 

1.0027379093  days  of  mean  sidereal  tlM  =  1  day  of 

mean  solar  time 

The  site  position  vector  can  be  calculated  as  follows: 


h  cos  (  L  )  cos  (  9  ) 
h  cos  (  L  )  sin  (.  B  ) 
h  sin  (  L  ) 

where 

h  =  distance  from  center  of  earth  to  site 
rs  =  site  vector 
L  =  latitude  of  site 
B  =  local  sidereal  time 


(2-12) 


The  coordinate  system  for  the  land  based  sensor  is  shown  in 
Figure  4. 


Figure  4  Land  Based  Sensor  Coordinate  System 

The  orbiting  sensor  is  a  bit  more  involved  as  it  requi¬ 
res  the  orbit  of  the  sensor  be  known.  The  semi-major  axis 
(a),  eccentricity  (e),  inclination  (i),  longitude  of  ascend¬ 
ing  node  (.  Q  ) ,  and  the  argument  of  periapsis  (  ui  )  are  input 
(reference  1  )  so  position  and  velocity  vectors  can  be  de¬ 
termined.  The  procedure  requires  the  determination  of  the 
mean  motion  and  then  the  mean  anomaly.  With  these  values,  r 
and  V  of  the  orbiting  sensor  can  be  calculated  as  follows: 

r  =  r  cos  1/  P  +  rsinl/Q 

and 

v=[/i/p]i/2  [  -  sin  +  (  e  +  cos  y  ] 


where 

true  anomoly 

unit  vectors  in  the  Perifocal  Coordinate  System 
( PQW , reference  1 ) 
semi-latus  rectum 

For  a  more  detailed  description,  see  Appendix  A  of  Vallado’s 


thesis  (reference  4). 

With  the  site  vector  known  in  both  cases,  range, 
azimuth,  elevation,  and  local  coordinate  sjrstea  can  be  deter¬ 
mined.  The  Topocentric-Horizon  Coordinate  System  (SEZ),  re¬ 
presented  in  Figure  5,  is  used  to  represent  range,  azimuth, 
and  elevation  data  of  the  launch  vehicle  ( reference  1 ) .  No- 


Figure  5.  Radar  Site  Geometry 

tice  that  the  azimuth  angle  is  measured  from  the  South  rather 
than  the  North  as  is  done  by  most  radar  sites.  This  is  done 
to  simplify  later  computations. 

Since  the  state  vector  and  all  input  data  are  in  the 
Geocentric-Equatorial  Coordinate  System  (UK)  (reference  1), 
an  orthogonal  set  of  unit  vectors  in  the  SEZ  frame  must  be 
developed  to  be  used  as  a  transformation  matrix.  Figure  6 
will  aid  in  determining  the  transformation  matrix. 

The  local  vortical  unit;  vector  (^)  is  derived  as: 


11 
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Z  =  ra  /  r« 


Figure  6  Observa1:ion  Geometry 


The  East  unit  vector  is  defined  as 


k  X  'Z'  /  1^  X 


While  the  South  unit  vector  is  defined  as: 


^  =  '^x'z'/l^x'z' 


The  transformation  matrix  can  then  be  shown  as: 

( •  )i  JK 

where 


A  I  A  ,  A 

[  S  I  E  I  Z  ]  (  .  )SEZ 


(2-13) 


(2-14) 


(2-15) 


(2-16) 


(•)iJi  =  an  arbitrary  vector  in  the  UK  frame 
(•)EBZ  =  an  arbitrary  vector  in  the  SEZ  frame 

[  ^  I  ^  j  ^  ]  =  orthogonal  basik  vector  ,3x3  matrix 
consisting  of  Equations  (2-13),  (2-14), 
and  (2-15) 


Since  the  inverse  of  an  orthogonal  transformation  matrix  is 


m 


L  M 


■  v•■.^ 


.1 


the  transpose.  It  can  also  be  stated  that: 


(•)WK  (2-17) 

With  the  proper  transformation  matrices  developed,  it 
is  now  possible  to  compute  the  range,  azimt''th,  and  elevation 
of  the  launch  vehicle.  The  range  is  be  defined  as: 

Put.  -  njE  -  rsiJi  (2-18) 


(•)8iz  = 


t 

€ 


and  transforming  to  the  SEZ  frame: 


P  SBZ 


P  I  JK 


Then  the  data  is  assembled  as  follows: 


(2-19) 


range  =  p 

azimuth  =  tan-i  (  jr  /  x  )  (2-20) 

elevation  =  teui-i  (  z  /  {  x*  +  jr*  )i/2  ) 


where 

x,7,z  =  components  of  the  position  vector  in  the 

UK  frame 

The  method  for  finding  the  unit  vectors  for  both  sensor 
tjrpes  is  the  same.  The  only  difference  is  the  calculation 
of  the  initial  site  vector. 


Truth  Model  Data 

Programming  the  equations  of  motion  and  numerically 
integrating  them  provided  the  truth  model  data.  Appendix  A 
lists  the  truth  model  program  and  all  subroutines  needed  to 
generate  the  simulated  radar  data  needed  to  test  the  estima¬ 
tion  algorithm.  To  generate  data  for  a  particular  launch 
vehicle  it  was  necessary  to  obtain  information  of  current 
launch  vehicles  in  the  present  U.  S.  inventory.  Specifically 
needed  was  Ve  cuid  M  (  m  /  mo  )  which  were  obtained  from 
reference  3.  Recalling  from  basic  propulsion  (reference  6): 

ffl  =  F  /  Ve  and  Ve  =  lap  g  auid  M  =  m  /  mo 

only  lap,  mo,  and  F  need  to  be  specified.  The  values  used 
in  the  truth  model  are  seen  in  Table  1 . 


Table 

1  Launch 

Vehicle  Data 

Titan 

34  D 

STAGE 

TIME(sec) 

ISP ( sec) 

THRUST (Ibf ) 

MASSo  ( Ibai ) 

1 

0.0 

301.6 

531,250.0 

410,028.0 

2 

165.0 

318.0 

100,700.0 

102,028.0 

3 

375.0 

295.0 

42,200.0 

24,028.0 

4 

520.4 

cutoff 

0.0 

2,628.0 

By  numerically  integrating  Equation  (2-9)  and  using  Table  1, 
the  observation  data  (truth  model).  Equation  (2-20),  was 


generated . 
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Next,  the  truth  model  was  generated  to  include  noisy 
data,  to  simulate  “real-life"  data.  The  method  to  obtain 
noisy  data  was  to  have  the  data  files  written  to  include 
random  errors  in  range,  azimuth,  and  elevation.  The  method 
involved  the  assumption  that  the  errors  would  occur  randomly 
as  per  a  Gaussian  distribution,  as  presented  by  Vallado’s 
thesis  (reference  4).  The  difference  between  measurements 
of  noisy  data  and  "perfect“data  is  defined  by: 


where 


range 

range 

azimuth 

-  (aau  O 

azimuth 

elevation 

elevation 

1 

(Sau  represents  a  Gaussian  function  whose  mean  =  0 

and  standard  deviation  is  1 


O  is  the  defined  accuracy  of  the  three  measurements 


The  accuracies  of  the  range,  azimuth,  and  elevation  measure¬ 
ments  are  specified  as: 


' 

_  — 

range 

.00001  DO 

azimuth 

.001  deg 

elevation 

.001  deg 

-  --  - 

(2-22) 


Then  using  partial  derivatives,  the  deviations  are: 


1 

- 

/ 

1 

range 

azimuth 

1 

=  Gau 

.00001 

.001 

1  ^ 

'  range 
azimuth 

elevation  , 

.001 

elevation 

i 

—  — 

i 

The  partial  of  range,  azimuth,  and  elevation  then  becomes  an 
identity  matrix  since  it  is  assumed  that  the  random  errors 
associated  with  the  three  measurements  are  independent  of 


each  other.  The  noisy  data  is  then  formed  as: 


/ 

!  ^ 

/  \ 

/  range 

/  range 

f  rcmge 

azimuth 

=  azimuth 

+  6  1  azimuth 

^  elevation j 

noisy  ^elevation 

perfect  1  elevation  / 

/ 

The  filters  will  be  developed  next  to  implement 


(2-24) 


the  dy¬ 


namics  formulated  in  this  chapter. 


III.  FILTER  DEVELOPMENT 


The  estimation  routine  will  be  required  to  process  sen¬ 
sor  data  (azimuth,  elevation,  range,  and  time)  and  determine 
positional,  velocity,  eind  launch  vehicle  stage  data.  A  se¬ 
quential  estimator,  Bayes  Filter  (reference  6),  will  be  used 
to  facilitate  the  detection  of  the  staging  event. 

Matrix  Equations 

Specification  of  the  state  vector  (reference  4)  will  be 
done  using  what  was  developed  in  Chapter  2.  It  is  defined 
as : 


where 


x,y,  z 
x,y,  z 
Ve  = 
M 


components  of  position 
components  of  velocity 
exhaust  velocity  of  stage 
mass  ratio  of  m  /  mo 


(3-1) 


Since  the  two-body  equations  of  motion  are  nonlinear, 
the  state  must  be  moved  to  the  next  observation  time  using  a 
numerical  integrator  (Naming,  a  fourth-order  predictor-correc 


tor  was  chosen,  reference  7).  The  equations  of  motion  are 


d/dt(x(t))  =  F{x(t),t)  (3-2) 


where  x(t)  is  the  state  vector  at  each  time.  This  is  just 
another  expression  for  Equation  (2-9).  The  F  vector  is  found 
to  be 


F(x(t).t) 


where 


a 


—  — 

—  — 

X 

X 

y 

y 

z 

Z 

X 

-X  /  r*  +  a  X  /  V 

y 

-y  /  r3  +  a  y  /  V 

z 

-z  /  r3  +  a  z  /  V 

Ve 

0 

M 

0 

_  _ 

-  — 

Ve  M 

[  l-M(t-t«ta«e)  ] 


(3-3) 


and  Ve  and  M  are  assumed  to  be  constant  for  a  particular 
stage . 

Now  that  the  relations  involving  the  equations  of  mo¬ 
tion  have  been  formulated,  the  relations  needed  to  correct 
the  estimate  of  the  state  vector  using  the  input  data  must 
be  formulated.  To  estimate  the  state,  a  nominal  trajectory 
is  assumed  as  a  function  of  time  (3c(t)),  with  initial  con¬ 
ditions.  The  true  trajectory  can  be  written  as: 


x(t)  =  Xo(t)  +  i  x(t) 


(3-4) 


where 

"xCt)  =  true  trajectory 

4x(t)  =  difference  between  true  and  nominal  trajectory 
xb(t)  =  nominal  trajectory 

Differentiating  the  true  trajectory  relation  yields: 


x(t)  =  xo(t)  +  S  x(t) 


(3-5) 


emd  modifying  Equation  (3-2)  produces: 


xo(t)  +  j  x(t)  =  'F(xo  (t)+  j  x(t)  ,  t ) 


(3-6) 


To  solve  this  equation,  we  expand  the  right  hand  side  using 
a  Taylor’s  Series  expansion  to  obtain: 

xo(t)+ix(t)=F(xo(t),t)  +  dF/5t_  ^x(t)  + 

«o(  t ) 

1/2  Vm  {V*  d  )L  (  5  x(t)  )»  + 

*o(t) 


H.O.T. 


(3-7) 


Now  assuming  that  j  x(t)  is  zero.  Equation  (3-7)  becomes: 


xo(t)  =  F(xo(t),t) 


(3-8) 


Ignoring  higher  order  terms  in  Equation  (3-7)  and  subtracting 
Equation  (3-8)  leaves: 


j  x(t)  =  A(t)  6  x(^) 

*o(  t ) 


(3-9) 


where  A(t)  =  0F(t)/5x  (the  A  matrix  is  derived  in  the 

Appendix  B) 

Recalling  Equation  (3-4),  we  may  specify  the  following  rela- 


»l' 


B 


I 


I 


x(t)  =^(t,to)  jx(to) 


(3-10) 


is  a  square  na-brix. 


where  0(1^, to)  E  5x(t)/6x(to) 

|To(  t ) 

the  state  trcinsition  matrix.  When  evaluated  along  a  known  so¬ 


lution,  the  state  transition  matrix  is  a  function  of  the 
start  and  stop  times  only.  It  calculated  from 


i(t,to)  =  A(t)|  0(t.to)  (3-11) 

{*oct) 

and  the  state  transition  matrix  initial  condition  is  pre¬ 
scribed  by 


0(to,to)  =  I  (3-12) 

where  I  =  identity  matrix. 

The  formulation  of  the  equations  responsible  for  the 
calculation  of  the  state  vector,  its  propagation  through 
time,  and  estimation  of  the  errors  from  the  true  trajectory 
have  been  completed.  The  next  step  is  to  process  the  data 
coming  from  the  sensors.  The  data  will  usually  be  a  nonlin¬ 
ear  function  of  the  state  vector  at  the  current  time  (ti ) 
and  of  the  observation  geometry. 

The  predicted  data  for  each  observation  is  given  by: 

T(ti  )  =G(£(ti).ti)  (3-13) 

By  evaluating  this  at  the  initial  time  we  are  left  with  the 
initial  conditions  as: 


Zo  (  ti  )  =  G  (  Xo  ( 1;i  )  ,  ti  ) 


(3-14) 


This  equation  can  be  linearized  as  we  did  with  Equation  (3-2) 
Knowing  that  there  will  be  a  difference  from  the  nominal 
trajectory.  Equation  (3-13)  can  be  rewritten  as 

z(ti  )  =  G(xo(ti)  +  3*x(ti),ti)  (3-15) 


where  ^x(ti )  is  the  difference  perturbation  from  true  data. 
This  can  be  expanded  as  was  done  in  Equation  (3-6)  and 
yields: 


z(ti  ) 


G  (  XO  ( ti  )  ,  ti  )  + 
+  H.O.T. 


d6(xo  (ti  )  ,ti  )/d  x(ti  ) 


5  x(ti  ) 

*o( ti  ) 


(3-16) 


Subtracting  this  ’true’  relation  from  the  calculated  rela¬ 
tion  and  ignoring  higher  order  terms  produces: 


r  ( ti  )  =  z  ( ti  )  -  zo  ( ti  ) 
=  dG/d^ 


6  X(ti  ) 


io(  ti  ) 

H(xo(ti  ),ti  )  ix’(ti  ) 


(3-17) 


In  previous  chapters  the  observation  relationships  were 
developed.  The  data  vector  G  consists  of: 

(3-18) 

The  H  matrix  is  defined  as: 


[G]  = 


range 

azimuth 

elevation 
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[H]  =  dG/a* 


(3-19) 


Using  the  observation  relationships  that  were  developed  in 
Chapter  1 : 

remge 
azimuth 
elevation 

where 

x,y,z  =  positional  components  in  the  UK  frame 
Since  only  x,  y,  and  z  appear  in  the  H  matrix,  the  first 
3x3  block  will  be  the  only  portion  that  is  not  zero. 
Therefore  the  first  3x3  block  of  the  H  matrix  is: 


(  x2  +  y*  +  z2  )  1/2 

tan-i  (  y  /  X  )  (3-20) 

tan-i  [  z  /  (  x2  +  y2  )  i/2  ] 


X  _ 

(  X2  +y2  +22  )l  yi 


Z _ 

(at2+y2  +z2  )l/2 


-2 - 

(x2  +y2+z2  )l/2 


-y/x2 

1  +  (y/x)* 


l/x 

1  +  (y/x)2 


-XZ/(x2+y2  )3/2  -yz/(x2  4-y2  )3/2 

1  +  z2  /  (  x2  +y2  )  1  +  z2  /  (  x2  +y 2  ) 


0 


l/(x2  +y2  )l/2 
1  +  z2  /  (  x2  +yfc  ) 


(3-21) 


Since  the  estimate  of  the  state  is  at  am  epoch  time,  to,  from 
measurements  taken  at  different  observation  times,  ti  ,  the 
residuals  are  moved  to  a  single  epoch  time.  Using  the  state 
transition  matrix  as  before: 


r(ti  )  =  H(xo  (ti  )  ,  ti  )  0  (ti  ,  to  )  <}x(to) 

=  T(ti  )  ix(to)  (3-22) 


where  T(ti  )  is  defined  as  H(xo(ti),ti)  0(ti,to). 


Now  that  the  required  matrices  have  been  defined,  the 
estimation  routines  can  be  developed. 

Nonlinear  Least  Squares 

From  what  has  already  been  developed,  the  state  vector 
is  given  by: 

T  =  F(x,t)  (3-23) 

with  deviation  of  the  state  vector  as: 

^'x(t)  =0(t,to)  4lc(to)  (3-24) 

The  observation  relationships  were  developed  as  the  G  ma¬ 
trix,  and  residual  data  was: 

T(ti  )  =  T(tt  )  ax(to)  (3-25) 

The  sensor  data  will  not  produce  perfect  data  and  the 
covariance  matrix  Q  tells  how  accurate  the  range,  azimuth, 
and  elevation  measurements  are.  The  residual  vector,  in¬ 
cluding  this  error,  can  be  shown  as: 

r(ti  )  =  T(ti  )  dx(to)  +  e(ti  )  (3-26) 

where 

e(ti )  =  acrual  error  associated  with  the  observation 
data 

Solving  Equation  (3-26)  for  the  error: 

e(ti  )  =  r(ti  )  -  T(ti  )  ax(to)  (3-27) 


For  this  research,  it  is  assumed  that  random  errors  in  range 
azimuth,  and  elevation  are  uncorrelated.  The  covariance  ma- 


I 


i- 


trix  (Q)  is  then  defined,  containing  information  as  to  the 


accuracy  of  the  measurements. 

Using  Gaussian  error  statistics,  the  probability  density 


function  for  the  error  vector  is: 


P(e)  =  (27r)-n/2  [Qj-l/2  exp  (-1/2  S)  (3-28) 

where 

n  =  number  of  measurements 
Q  =  data  covariance  matrix 

S  =  eTQ-ie"  (a  scalar)  welid^ted  least  squares  function 
Using  the  principle  of  maximum  likelihood  (reference  5),  S 
(volume  of  error  ellipsoid)  is  minimized  to  make  P  a  maximum. 


Therefore : 


dS/dx  =  a(eTQ-»e)  /Qx 


(3-29) 


Now  substituting  Equation  (3-27)  into  S  leaves: 


S  =  (7  -  T  ax)T  Q-i  (F  -  T  dx) 

=  Ft  Q-i  F  -  rT  Q-i  T  -  g'x  TT  F 
+  dxt  TT  Q-i  T  d'x 


(3-30) 


Note  that  the  functional  dependence  on  time  has  been  left 
out  to  help  in  the  clarity.  Equation  (3-29)  becomes: 


0  =  -  (?T  Q-i  T)T  -  TT  Q-i  r  +  (  ixT  Tt  Q-i  T)T 
+  17  Q-i  T  ix 


(3-31) 


We  then  solve  Equation  (3-31)  for  (Jx: 


6x  =  (TT  Q-i  T)-i  TT  Q-»  r 


(3-32) 


i 
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This  result  is  valid  when  the  reference  trajectory  and  the 
actual  trajectory  are  very  close  and  the  inverse  of  TTO'^T 
exists.  The  requirement  that  ‘H'Q'iT  have  an  Inverse  is 
called  the  observability  condition  (reference  5). 

Now  that  we  have  an  estimate,  we  must  now  assess  the 
quality  of  the  estimate.  We  need  to  calculate  the  covar¬ 
iance  of  the  estimate  as: 

Pk(t)  =  E(  i  x(t)  dx(t)T)  (3-33) 

Noting  that  S  x  can  be  written  as 

ix  =  W  r  (3-34) 

and  substituting  it  into  Equation  (3-33)and  evaluating  at  to, 
leaves: 


Px(to)  =  W  E(r  rT)  wr  (3-35) 

This  assumes  that  W  is  deterministic  and  can  therefore  be 
brought  outside  of  the  expectation  operator.  Recalling  that 
E(r  rT )  is  defined  as  the  covariance  matrix  Q  where  ~r  is  the 
the  zero  mean,  it  is  shown: 

Pi  (to  )  =  W  Q  WT  (3-36) 

Expanding  this  with  the  definition  of  W: 

Pi(to)  =  (TT  Q-i  T)-l  IT  Q-l  Q  [(IT  Q-i  T)-»  IT  Q-l]T 


(IT  Q-i  T)-i  IT  Q-i  T  (IT  Q-i  T)-t 
(TT  q-i  T)-i 


(3-37) 


The  final  step  is  to  define  when  the  estimator  has 


reached  convergence.  Ideally  ix  will  reach  zero,  but  it 
is  sufficient  to  stop  the  iteration  when  the  state  correc¬ 
tions  are  all  less  than  the  square  root  of  their  individual 

covariance  values  (reference  4).  The  estimate  is  not  worth 

/ 

knowing  to  a  precision  that  is  higher  than  Px  indicates  (ref 
erence  5 } . 

The  algorithm  for  the  nonlinear  least  squares  estimator 
routine  is  in  Appendix  C. 

Eaves  Filter  Development 

The  Bayes  Filter  is  basically  a  sequential  nonlinear 
least  squares  algorithm.  It  allows  the  estimate  and  covari¬ 
ance  of  one  estimator  to  serve  as  data  to  another  estimator. 
If  the  first  estimate  was  carefully  done,  it  contains  all 
the  Information  from  the  previous  segment  of  data  worth  re¬ 
membering  as  well  as  a  covariance  matrix  to  indicate  how  much 
the  estimate  c2m  be  trusted  (reference  5). 

The  Bayes  Filter  forms  eui  estimate  from  two  types  of 
data.  The  "new"  data  'z  consists  of  observation  data  and  the 
"old"  data  consists  of  the  previous  estimate  It(-).  The  ob¬ 
servation  relationship,  as  was  defined  by  Equation  (3-13),  is 

z  =  G(7,t)  (3-38) 

and  the  observation  relationship  for  the  previous  estimate 
is 
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x(-)  r  Ix 


(3-39) 


while  the  observation  matrix  can  be  written  as 


(3-40) 

where  Tx  =  observation  matrix  for  the  "new"  data. 

The  covariance  matrix  representing  the  "old"  estimate  and  the 
"new"  data  is: 

“1 

-  (3-41) 


Q 


P(-)  I 

crn 


where 


P(-)  =  covariance  of  "old"  estimate 
Qs  =  covariance  of  "new"  estimate 

and  the  residual  vector  is  defined  as 


x(-)  -  xref 
T  -  G(x) 


(3-42) 


where  the  obvious  starting  point  for  the  reference  trajectory 
is  the  "old"  estimate.  The  familiar  form  of  least  squares 
is  then  used  to  estimate  the  new  state  x(+).  Recalling  Equa¬ 
tion  3-37,  the  inverse  covariance  matrix  for  the  new  data  is: 


P-I  (  +  )  =  (  P-i  (-),  T.T  0,-1 


=  P-i  +  TzT  0,-1  Ti 


(3-43) 


The  correction  to  the  state  can  then  be  defined  as: 
(5x(to)  =  P(  +  )  TT  Q-i  r" 

=  P(+)  (  P(-),  T.T  0,-1  ) 

=  P(  +  )  C  P-i(-)  {x(-)  -  lief]  +  T«T  0,-1  ii]  (3 

An  algorithm  for  the  Bayes  Filter  is  contained  in 


Appendix  D. 


The  estimation  routine  developed  by  Capt.  Vallado  in 
his  thesis  (reference  4)  was  only  marginally  successful  in 
dealing  with  a  staging  event.  He  achieved  partial  success 
when  the  staging  event  occurred  at  the  end  of  a  Bayes  Filter 
segment.  This  problem  was  compounded  when  the  dynamics  were 
altered  to  allow  for  multi-staged  vehicles.  The  staging 
estimator  will  be  responsible  for  detecting  that  an  event  has 
taken  place,  estimating  the  time  of  staging,  exhaust  velocity, 
and  mass  ratio  of  the  next  stage,  and  returning  to  the  Bayes 
Filter  to  continue  processing  sensor  data. 

Staging  Event  Detection 

The  change  in  dynamics  can  be  utilized  in  determining 
that  a  staging  event  has  taken  place.  After  staging  has 
occurred,  the  Hauning  numerical  integrator  is  still  propagat¬ 
ing  the  old  dynamics  in  time  while  the  sensor  data  is  reflect¬ 
ing  a  distinct  change  in  acceleration.  This  "out-of -track" 
condition  cam  be  reflected  amalytically  as  follows: 

rrea.IJK  =  rHAMI  NG  -"rOBSKR  (4-1) 


where 


nes.iJK  =  difference  between  position  vectors  from 
Haming  amd  from  the  observations,  both 
in  the  UK  fraune 

'Biaaing  =  position  vector  from  Haming  reflecting  the 
dynamics  of  the  "old"  stage 

robaer  =  actual  vehicle  position  as  the  sensor  sees  it 


In  order  to  compute  the  "in-track"  residual,  the  sensor  ob- 


servation,  consisting  of  range,  azimuth,  euid  elevation  data, 
must  be  converted  to  a  position  vector  in  the  UK  frame. 
Recalling  the  observation  relationships  developed  in  Chapter 
2  (see  Figure  5),  the  p  vector  can  be  represented  in  the  SEZ 
frame  by: 

P  6BZ  =  pcos(az)cos(el)  ^  +  P  sin(az)cos(el)  ^  + 

psin(el)  ^  (4-2) 

where 

p  =  |/7sez|,  the  sensor  range  measurement 

az  =  azimuth  angle  measured  from  the  South  (C(7W) 
el  =  elevation  angle  measured  up  from  the  S  and  E 
plane 

Now  that  we  have  the  "p  vector  from  the  sensor  site  to  the 
observation  site,  it  must  now  be  converted  to  the  UK  frame 
as  follows: 

Pijz  =  ^  ^  ^  "pSEZ  (4-3) 

where  the  transformation  matrix  was  developed  in  (Chapter  2 
(Equation  (2-16)).  Once  we  have  the  p  vector  in  the  UK 
frame,  the  position  vector  in  the  UK  frame  cem  be  defined 
as: 

robaer  =  rs  0  (4-4) 

where 

robaer  =  the  position  vector  of  the  observation  point 
converted  to  the  UK  frame 

rs  =  position  vector  of  the  radar  site  in  the  UK 

frame 

From  Equation  (4-1),  it  is  obvious  that  once  the  staging 


event  has  taken  place,  the  deviation  between  the  numerical 


solution  auad  the  observation  data  will  increase  with  time. 

It  is  now  left  to  define  at  which  point  in  this  out-of-track 
condition  to  declare  that  a  staging  event  has  tcJcen  place. 
For  this,  an  in-track  covariance  matrix  must  be  developed 
using  the  methods  introduced  in  Chapter  3. 

The  in-track  residual.  Equation  (4-1),  will  aid  in  the 
formulation  of  the  appropriate  covariance  value.  What  is 
needed  is  an  estimate  of  the  accuracy  of  an  in-track  condi¬ 
tion  as  a  function  of  the  observation  data  accuracy.  To 
begin,  the  in-track  residual  will  be  redefined  in  the  direc¬ 
tion  of  the  thrust  since  the  deviation  in  the  trajectory  is 
due  to  the  change  in  thrust.  Therefore,  Equation  (4-1)  can 
be  expressed  as: 

Ti  jk 

^riatrk  =  ne8,ijk»  _ —  (4-5) 

1  Vi  jk| 


where 

'nes.ijk  =  defined  in  Equation  (4-1) 

^rintrk  =  intrack  residual  (scalar)  in  direction  of 
thrust 

Vijk  =  velocity  vector  for  vehicle,  available 

from  Earning 

With  the  in-track  residual  now  expressed  in  the  direction  of 
the  velocity  vector,  the  covariance  of  the  in-track  residual 
Ccin  be  defined  as: 


(y^intrk  =  E  (ir^intrk)  (4-6) 

where 
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(;2intrk  =  represents  the  1x1  in-track  covariance 
matrix 

E  (  •  )  =  expectation  operator  introduced  in  Chapter 

3 

jrintrk  =  differential  of  Equation  (4-5) 


To  compute  the  covariance  matrix,  the  differential  of  Equa¬ 
tion  (4-5)  must  be  defined.  Allowing  that  the  residual  is 
independent  of  the  frame  computed  in.  Equation  (4-5)  can  be 
rewritten  as  follows: 


vsez 

^rintrk.ijk  =  ^rintrk.aes  =  irreB.aez*  -  (4-7) 

l^e.j 

Recalling  Equation  (2-17),  the  velocity  component  can  be  writ 
ten  as: 


vsez 
( vs  e  z| 


Sit 


Vi  jk 

fvi  jkl 


(4-8) 


Since  all  the  uncertainty  is  assumed  to  be  contained  in  the 
observation  data  (i.e.  assuming  the  problem  is  modeled  ade¬ 
quately),  the  differential  of  Equation  (4-5)  can  be  expressed 
as : 


i  rres.sez  =  -  ^  robser vat i on  (4-9) 

Using  Equation  (4-4)  and  assuming  the  position  vector  of  the 
sensor  (land  based  or  space  based)  is  known  to  a  much  higher 
degree  of  accuracy.  Equation  (4-9)  may  be  written  as: 

i  Tx  es  ,  sez  =  - 
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4  P  aez 


(4-10) 


where  jPsBZ  =  differential  of  Equation  (4-2).  With  Equation 
(4-8)  and  (4-10),  Equation  (4-7)  can  be  rewritten  as-* 


6  ^nntrk  =  fipstZ  • 


[  I  E  /  ]T 


VSex  J 

I  Vk  e  X I  \ 


(4-11) 


The  differential  of  Equation  (4-2)  in  component  form  is: 


^SEZ  =  [  cos(az)  cos(el)  jp  -  p  sin(az)  cos  (el)  j  az  - 
pcos(az)  sin(el)  ^  el  ]  ^  t  [  sin(az)  cos(el)jp 
+  pcos(az)  cos(el)  d  az  -  Psin(az)  sin(el)  d  el  ] 

+  [  sin(el)  d  P  +  P  cos(el)  d  el  ]  ^  (4-12) 


Using  Equation  (4-12)  and  performing  the  scalar  (dot)  product. 
Equation  (4-11)  becomes : 


(J^rintrk  =  -  v-l«ex  [  vs  cos(az)  cos(el) 

+  vE  sin(az)  cos(el)  +  vz  sin(el)  ]  dp  - 
v-iaex  [vE  p  cos(az)  cos (el) 

-  vs  p  sin(az)  cos(el)  ]  d  az  - 

v-l»ex  [  vz  p  cos(el)  -  vs  P  cos(az)  sin(el) 

-  VE  P  sin(az)  sin(el)]  j  el 

(4-13) 


where 

■^ex  =  vs§  +  VE^  +  vz^* 

Vaex  =  [  vs2  +VE2  +vz2  ]l/2 

In  most  radar  systems  the  uncertainty  of  the  measurements  for 
range,  azimuth,  cuid  elevation  are  independent  of  one  another. 
For  this  research,  it  will  be  assumed  that  the  three  measure- 


ments  are  independent  of  each  other  2md  when  Equation  (4-13) 
is  squared,  the  cross  terms  will  be  neglected.  Therefore, 
Equation  (4-6)  can  be  rewritten  as: 

a^intrk  =  v-^aex  C  VS  cos(az)  sin(el)  +  vK  sin(az)  cos(el) 

+  vz  sin(el)  ]2  a  Grange  +  vZae*  [  VI  />  cos(az)  cos(el) 

-  -vz  p  sin(az)  cos(el)  ]2  ff  2ax  +  v-2sex  [  vz  p  cos(el)  - 
vs  p  cos(az)  sin(el)  -  vs  p  sin(az)  sin(el)  ]2  a  2ei 

(4-14) 

Now  that  an  in-track  error  value  has  been  derived  in  terms 
of  the  individual  errors  of  the  observation  data,  it  is  im- 
portemt  to  establish  the  criteria  for  determining  whether  a 
staging  event,  an  "out-of -track*  condition,  exists.  This 
will  be  done  by  comparing  the  in-track  residual  to  the  ”3- 
sigma"  (  3*<7intrk  )  value  of  the  error  as  derived  in 
Equation  (4-14).  If  the  in-track  residual  is  outside  the  3- 
sigma  envelope  for  three  successive  observation  points,  a 
staging  event  will  be  declared.  Using  three  sucessive  points 
as  the  criteria  was  chosen  to  preclude  the  possibility  of  a 
single  "bad"  observation  point  triggering  the  staging  event 
detector. 

The  probability  of  the  value  of  the  in-track  residual 
being  within  the  3-sigma  interval  is  slightly  over  99  percent 
( reference  5 ) . 


estimator  is  responsible  for  determining  the  next  stage's 
vehicle  characteristics.  The  change  in  vehicle  exhaust 
velocity  and  mass  ratio  (as  defined  in  Equation  (2-8))  result 
in  a  definite  change  in  vehicle  acceleration.  Also,  since 
the  dynamics  reflect  the  time  of  staging  as  in  Equation  (2-8), 
the  in-track  residual  (defined  in  Equation  (4-7)  as  a  differ¬ 
ence  in  position)  is  assumed  to  be  a  direct  result  of  the 
change  in  acceleration  due  to  staging.  Therefore,  it  can  be 
written: 


^  ri  nt  r  k 


t 

^  ai  nt  r  k  dt 

tsnew 


(4-15) 


where 


aintrk  =  auild  -  amew 


(4-16) 


and 

a  =  Equation  (2-5) 

tsnew  =  new  stage  time 

In  order  to  develop  the  dynamics  to  be  used  in  the 
staging  estimator,  the  integration  of  Equation  (4-15)  must 
be  performed.  Recalling  Equation  (2-8),  Equation  (4-16)  may 
be  written  as: 

Veold  Mold  Venew  Hbew 

^  aintrk  =  .  -  ■  . —  (4-17) 

1-Mol  d  ( t-tsol  d  )  l-)kew  (t-tsnew  ) 


Noting  that  the  difference  (t-tsnew)  is  small  after  the 


staging  event  occurs,  the  first  term  is  rewritten  as'- 


aold  =  Veold  Hold  [  1-Hol  d  (tsnew-tsol  d  )  ]  * 

['Hold(t-tsnew)]  -1  (4-18) 

Equation  (4-18)  is  then  expanded  in  binomial  form  as: 

aold  =  Veold  Mold  [  1-Mol  d  ( tsne  w -tSol  d  )  ]- ^  + 

[  1-Mol  d  ( tsneif-tsol  d  )  ]“  2  [-Mol  d  ( t-tsne w  )  ] 

+  H.O.T. 

By  neglecting  higher  order  terms.  Equation  (4-18)  can  be  ap¬ 
proximated  by: 

Veold  Mold  Veold  M^old 

ao  1  d  I  ■  —  N  I  ■■■ 

[1-Mol  d  (tsnew-tsol  d  )  ]  [1-Mol  d  (tsnewtsol  d  )  ]* 

(4-19) 

The  second  term  of  Equation  (4-17)  can  also  be  binomially  ex 
panded  as: 

anew  =  Venew  Ifeew  [  1+Ifaew  ( t-te  new  )  +  H.O.T.  ] 

Again  neglecting  the  higher  order  terms,  it  may  be  rewritten 
as : 

anew  di  Venew  Miew  Venew  M^new  (t-tsnew)  (4-20) 

With  the  two  approximations  just  developed.  Equation  (4-17) 
can  be  redefined  as: 


where 

Veold  Mold 

Ao  =  - - - - —  ~  Venew  Fkeir  (4-22) 

[  1-Mol  d  ('bsnew-'bsol  d  )  3 

and 

Veold  M^old 

Bo  =  '  ■  ■  -  . -  ■  -  -  — —  -  Venew  If^new  (4-23) 

[  1-Hol  d  (hsnew-'bsol  d  )  3^ 

Integrating  Equation  (4-17),  the  dynamics  for  the  nonlinear 
least  squares  staging  estimator  becomes: 

^rintrk  Ao  (t-tsnew)2  +  JBo  (t-tsnew)*  (4-24) 

T  6 

Now  that  the  basic  equations  for  the  staging  estimator 
have  been  developed,  the  matrix  equations,  identified  in  Chap¬ 
ter  3,  are  left  to  be  developed-  The  state  vector  is  defined 
as: 

rVeneiT] 

X  =  (feew  (4-25) 

ItSnoi^ 

where 

Venew  =  exhaust  velocity  of  the  next  stage 
rfeew  =  mass  ratio  (m/mo )  of  next  stage 
tsnew  =  time  of  staging 

Since  the  three  values  of  the  state  matrix  are  essentially 
constants  for  a  particular  stage.  Equation  (3-2)  can  be  ex¬ 
pressed  as: 

X  =  0  (4-26) 
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Equalvion  (4-26)  slnply  states  that  the  estimate  of  the  in¬ 
track  residual  does  not  need  to  be  moved  through  time  using 
a  numerical  Integrator.  This  simplifies  the  algorithm  ex¬ 
tensively.  Equation  (3-11)  can  be  expressed  as: 

0(t.to)  =  0  (4-27) 

Therefore,  applying  the  initial  condition  to  Equation  (3-11), 
as  specified  in  Equation  (3-12),  Equation  (4-27)  becomes: 

^(ti  .to)  =  I  (4-28) 

where 

I  =  Identity  matrix 

For  this  simplified  version  of  a  nonlinear  least  squares 
algorithm,  the  predicted  value  for  the  estimator  as  defined 
in  Equation  (3-13)  is: 


z(ti)  =  ^nntrk 


(4-29) 


where  the  right  side  of  the  equation  is  represented  by  the 
right  hand  side  of  Equation  (4-25)  evaluated  at  observation 
time  ti  and  the  current  state  vector  estimate.  Essentially 
there  is  no  [6]  vector  as  the  right  hand  side  of  Equation  (4- 
29)  is  a  scalar. 


z(ti  ) 


=  Ao  (tl-tsnew)*  +  Bo  (ti-tsnew)3 
2  6 


(4-30) 

Now  that  the  predicted  value  has  been  defined,  it  is  left 


to  formulate  the  [H]  matrix  and  then  the  [T]  matrix  in  order 
to  have  all  the  components  for  the  estimator.  As  defined  in 
Equation  (3-19),  the  [H]  matrix  can  be  defined  as  the  partial 
derivative  with  respect  to  the  state  vector  of  the  right  hand 
side  of  Equation  (4-30).  Therefore  it  can  be  stated: 


[H]  =  [  Hii  :  Hi2  •  Hi3  ] 


(4-31) 


where 

Hii  = 


Miew (t-tSneM )3 


2 


M^new  (t-tSnew)3 


6 


Hi2 


Venew (t-tsnew )2 


Miew  (t-tSnew)* 


H13  = 


Veold  M^old  (t-tsnew)* 
2[  1  “Mol  d  ( tsne  w-tsol  d  ) 


Mold  (t-tsnew) 

3  [1-Mo I  d  ( tsnew-tsol  d  )  ] 


(t-tSnew)  Bo 

(t-tsnew)  [  Ao  +  - ] 


As  defined  by  Equation  (3-22),  the  [T]  matrix  ceun  now  be  ex¬ 
pressed  as: 


T(ti  )  =  H(xo(ti  ),ti  )  0(ti,to)  (4-32) 


and  since  the  state  tremsition  matrix  is  defined  as  the 
identity  matrix  throughout  the  staging  estimator,  this 


where  i  deno-bes  values  evaluated  at  the  observation  time  ti 


With  the  addition  of  the  [T]  matrix,  the  required  matrix 
equations  have  been  developed  as  applied  to  the  staging  es¬ 
timator.  It  is  then  left  to  follow  the  procedure  as  out¬ 
lined  in  Chapter  3  for  the  nonlinear  least  squares  routine. 
The  only  difference  is  the  estimate  need  not  be  propagated 
in  time  to  the  next  observation  point  as  required  by  the 
main  program. 

Reentering  Baves  Filter  Estimator 

Now  that  the  new  stage  vehicle  parameters  £uad  staging 
time  have  been  estimated,  the  procedure  for  returning  to  the 
Bayes  Filter  algorithm  must  be  developed. 

The  first  step  is  to  determine  the  point  in  the  Bayes 
Filter  data  segment  that  corresponds  to  the  observation  data 
point  that  occurs  just  prior  to  the  estimated  staging  time. 
Having  done  that,  it  is  important  to  compute  am  estiniate  of 
the  state  vector  as  defined  in  Equation  (3-1).  The  staging 
estimator  state  vector  (Equation  (4-25))  represents  an 
initial  value  for  the  exhaust  velocity  and  mass  ratio  of  the 
next  stage.  An  estimation  of  the  position  euid  velocity  com¬ 
ponents  of  the  main  state  vector  (Equation  (3-1))  need  to  be 
specified  just  prior  to  the  estimated  staging  time.  This  can 
be  done  by  using  of  the  Haming  integrator  routine  as  used  by 
the  Bayes  Filter  algorithm.  The  estimate  of  the  state  vector 
prior  to  the  segment  of  observation  data  containing  the  stag¬ 
ing  event  is  propogated  through  time  to  the  estimated  staging 


time.  This  will  serve  as  an  initial  value  for  the  position 
and  velocity  components  of  Equation  (3-1). 

Once  an  estimate  for  the  next  stage’s  state  vector  at 
the  estimated  staging  time  has  been  computed,  the  observation 
data  segment  must  be  reinitialized  to  include  the  data  im¬ 
mediately  following  the  staging  event.  This  is  accomplished 
by  moving  the  remaining  observation  data  points  to  the  front 
of  the  current  segment  of  data  being  estimated,  amd  then  add¬ 
ing  more  data  from  the  sensor  data  file  to  fill  the  current 
segment  array. 

Now  it  is  left  to  compute  a  new  P~ > ( - )  term  (Equation 
(3-40))  at  the  new  epoch  time  specified  by  the  estimated 
staging  time.  With  the  P(-)  matrix  available  at  the  last 
epoch  time  and  recalling  the  Idea  of  the  state  transition 
matrix,  it  can  be  stated: 

P(ti  )  =  0(ti.to)  P(to  )  ( ti  .  to  )  (4-34) 

where 

P(to )  =  covariance  matrix  at  old  epoch  time 

0(ti,to)  =  Equation  (3-11),  designed  into  the  Haming 
routine 

The  inverse  of  Equation  (4-34)  is  then  computed  as: 

P^M-)  =  [0(ti,to)  P(to)  0T(ti  .to)  )-»  (4-35) 

Having  accomplished  this,  the  Bayes  Filter  is  then  allowed  to 
continue  processing  data  for  the  next  stage. 


V.  RESULTS  AHfi 


The  objective  of  this  paper  is  the  detection  of  a  stag¬ 
ing  event,  estimation  of  the  next  stage's  vehicle  parameters 
(Ve  and  M)  including  the  staging  time,  and  continuation  of 
the  main  Bayes  Filter  algorithm  for  processing  of  subsequent 
stage  sensor  data.  The  computer  programs  presented  by  Capt. 
Vallado  in  his  thesis  (reference  4)  are  used  extensively  in 
this  paper.  The  various  testing  routines  developed  by  Capt. 
Vallado  to  tost  the  individual  portions  of  the  Bayes  Filter 
algorithm  will  not  be  repeated  in  this  thesis  as  it  would 
serve  no  useful  purpose  to  revalidate  cm  algorithm  which  has 
already  been  successfully  used.  Bearing  this  in  mind,  the 
first  task  to  accomplish  is  the  verification  of  the  final 
results  attained  by  Capt.  Vallado  in  his  thesis.  This  will 
serve  as  a  "check"  to  verify  the  programs  he  was  working  with 
at  the  end  of  his  research.  Once  this  has  been  accomplished 
the  objectives  of  this  reseach  can  be  investigated. 

Truth  Model  Data  Formulation 

Early  in  the  program  verification  phase,  it  was  dis¬ 
covered  that  although  Capt.  Vallado' s  results  were  exactly 
duplicated,  a  problem  was  encountered.  By  extending  the 
flight  time  to  generate  multi-stage  data,  the  data  being 
generated  for  stage  two  reflected  a  "negative  mass"  sit¬ 
uation.  It  was  discovered  that  the  equations  of  motion  for 
the  launch  vehicle  did  not  include  the  ability  to  generate 


data  for  more  than  one  stage  (Equation  (2-6)).  Once  the  dy¬ 
namics  were  changed  to  reflect  the  multi-. staged  vehicle 
(Equation  (2-7)),  the  "negative  mass"  problem  was  solved. 

With  confidence  that  the  generated  sensor  data  was  correctly 
being  computed,  the  stage  event  detection  routine  was  devel¬ 
oped. 

Staging  Evept  Detection 

In  (%apter  4,  the  routine  for  detection  of  a  staging 
event  was  developed.  The  in-track  residual  (Equation  (4-5)) 
was  computed  for  each  Bayes  Filter  segment  of  data  during  the 
first  iteration  of  the  nonlinear  least  squares  portion  of 
the  algorithm.  Typical  values  for  in-track  residuals  compu¬ 
ted  are  listed  in  Table  2. 

Table  2  Typical  In-track  Residual  Values  Before  Staging 


OBSERVATION  TIME  (TO) 

RESIDUAL 

0 . 2008071880069E+00 

-0 . 5166060968207E-13 

0 . 2013029665306E+00 

-0. 3636990438151E-13 

0 . 2017987450543E+00 

-0 . 6292637105828E-13 

0 . 2022945235780E+00 

-0.5920873811415E-13 

0 . 2027903021017E+00 

-0. 6187166496192E-13 

The  in-track  residual  represents  the  difference  in  vehicle 
position  that  exists  between  the  numerically  integrated  value 
(predicted)  cind  the  observation  data.  This  difference  is 
computed  in  the  direction  of  the  velocity  vector  (thrust  dir¬ 
ection)  .  The  "smallness"  of  the  numbers  indicates  an  "in¬ 
track"  condition  exists  prior  to  staging.  A  typical  sequence 


OBSERVATION  TIME  (TO) 


RESIDUAL 


0 . 2052691947202E+00 

-0. 1123816712054E-05 

0 . 2057649732439E+00 

-0.2311412768374E-05 

0. 2072523088151E+00 

-0. 1266778422883E-04 

0 . 2122100940521E>00 

-0 . 1029856901690E-03 

0. 2196467719077E+00 

-0 . 4145433471524E-03 

Staging  ocurred 

at  .2045082E+00 

Noting  Table  3,  it  Is  apparent  that  a  deviation  from  the 
"in-track"  condition  exists.  This  is  due  to  the  numerical 
integrator  moving  the  estimate  through  time  using  different 
dynamics  than  the  observation  data  reflects.  Equation  (2-8) 
has  changed  to  reflect  a  staging  event  has  occurred.  A  graph¬ 
ical  representation  of  the  staging  event  is  presented  in 
Figure  7.  Figure  7  represents  the  in-track  residuals  plot¬ 
ted  as  a  function  of  time.  The  residuals  after  the  staging 
event  increase  rapidly. 

Now  that  the  staging  event  is  identified  graphically, 
the  sharp  rise  in  in-track  residual  values  reflected  in  Fig¬ 
ure  7  can  be  used  to  detect  the  event.  In  (Chapter  4,  the 
procedure  for  developing  an  in-track  error  value  (  aintrk, 
Equation  (4-14))  was  developed.  It  is  computed  as  a  func¬ 
tion  of  sensor  data  accuracy  as  defined  in  Equation  (2-22). 
Typical  values  for  the  in-track  error  are  presented  in  Table 


SEGMENT 


s  very  little  from  segment  to  segment 
4  In-track  Error  Values 


SEGMENT  (7  i  n  t  r  c  k 

2 

0 . 1666674317104E-03 

4 

0 . 1669833891639E-03 

6 

0 . 1674669890607E-03 

8 

0 . 1680668838485E-03 

as  it  is  just  a  function  of  the  observation  data  accuracy  in 
the  direction  of  the  velocity  vector.  This  is  attributed  to 
the  basic  assumption  that  the  measurement  accuracies  do  not 
change  with  respect  to  time  or  range. 

With  the  computed  in-track  error  value  (  a  intrk  )  it 
is  a  simple  process  to  compare  it  with  the  in-track  residuals 
to  determine  if  a  staging  event  has  taken  place.  As  defined 
in  Chapter  4,  the  "3-sigma“  value  is  used  to  determine  a 
staging  event  has  taken  place.  When  the  first  three  consec¬ 
utive  values  of  the  in-track  residual  become  larger  than  the 
"3-sigma“  value  a  staging  event  is  declared.  With  the  detec¬ 
tion  of  the  staging  event,  the  next  stage’s  vehicle  parame¬ 
ters  and  staging  time  must  be  estimated. 

Staging  Time  and  Vehicle  Paramf»t.F>r  Estimation 

The  staging  estimator  developed  in  Chapter  4  was  margin¬ 
ally  successful  for  estimating  the  staging  time  and  poor  for 
estimating  the  vehicle  parameters  for  the  next  stage.  Table 
5  shows  the  covariance  and  state  estimation  verses  the  actual 


values  for  M,  Ve ,  and  tsta^e.  This  was  accomplished  by 


COVARIANCE  MATRIX  AFTER  10  ITERATIONS 


0.5569853112E+04 

0.3463431509E+05 

0.2494213280E+00 

-0 . 34634315092E+05 
0.21536776000E+06 
0.15455896996E+01 

-0.24942132797E+00 
0. 15455896996E+01 
0.16662358470E-04 

ESTIMATION  OF  STATE  VARIABLES  AFTER  CONVERGENCE 

Ve 

M 

tatage 

-0.213423948E+02 

0.15607495538E+03 

0.20509324656E+00 

ACTUAL  STAGE  TWO  VEHICLE  PARAMETERS 

0.3941439263E-I-00 

0.25041207011E+01 

0.20450820360E+00 

processing  all  the  in-track  residual  data  points  for  the 
Bayes  Filter  segment  that  the  staging  event  occurred  in.  Using 
the  convergence  criterion  defined  in  Chapter  3,  convergence 
was  achieved  after  one  iteration.  The  data  reflects  a  poor 
estimation  in  the  Ve  and  M  (a  negative  Ve  is  impossible)  por¬ 
tion  of  the  state  vector  and  a  relatively  good  one  for  the 
staging  time.  In  an  attempt  to  give  the  estimator  more  time 
to  compute  a  better  estimate  of  the  state,  the  criterion  for 
convergence  was  reduced  by  two  orders  of  magnitude.  The  re¬ 
sults  of  this  case  are  reflected  in  Table  6.  Although  con¬ 
vergence  was  not  achieved,  it  was  a  good  exeunple  of  the  ina¬ 
bility  of  the  estimator  to  determine  the  second  stage  vehicle 
parEuneters . 

With  confidence  that  the  estimator  was  functioning  as  it 
was  designed  to,  a  decision  was  made  to  redevelop  the  stag¬ 
ing  estimator  to  allow  for  only  a  two-stage  estimate. 


Table  6  Three-Sbabe  Esblmabion 


INITIAL  ESTIMATE 

Ve  M  batafe 

0.39414392630E+00  0 . 25041207011E+01  0 . 20450820000E+00 

ITERATION  »  1  STATE  CORRECTIONS 
0. 10868680693E+02  -0 . 67517133822E+02  -0. 58288645895E-03 

CURRENT  STATE  ESTIMATE 

0.11262824620E+02  -0 . 65013013121E+02  0 . 20392531354E+00 

ITERATION  «  3  STATE  CORRECTIONS 
-0.51235725356E-03  0 . 15004630567E+04  -0 . 90516578867E-04 

CURRENT  STATE  ESTIMATE 

0.10053896683E-02  0 . 14356543640E+04  0 . 20383418292E+00 

ITERATION  #  5  STATE  CORRECTIONS 
0.43724066445E-02  -0 . 25322025281E+03  -0. 22816475211E-03 

CURRENT  STATE  ESTIMATE 

0.68936211756E-02  -0 . 17340831041E+02  0. 20419900563E+00 

ITERATION  n  7  STATE  CORRECTIONS 
-0.99088477821E-01  -0 . 40857299492E+01  -0 . 49256693124E-05 

CURRENT  STATE  ESTIMATE 

0.23073217627E-02  0 . 47975652083E+03  0 . 20394230354E+00 

ITERATION  n  9  STATE  CORRECTIONS 
0.32538670180E-02  -0 . 18809488825E+03  -0 . 21591223996E-03 

CURRENT  STATE  ESTIMATE 

0.65521596420E-02  0 . 53432099068E-»-02  0 . 20419681910E-t-00 

EXACT  VALUES 

0.39414392630E+00  0 . 25041207011E+01  0 . 20450820000E+00 


Recalling  the  problems  encountered  trying  to  estimate 
the  exhaust  velocity  and  mass  ratio  separately  (first  indica¬ 


tion  of  possible  observability  problem) ,  it  was  decided  to 
alter  the  staging  estimator  and  attempt  to  estimate  the  pro¬ 
duct  of  the  two  vehicle  parameters.  Therefore,  Equation  (4- 
25)  can  be  rewritten  as: 


MVeNEW 
tsHl  w 


(5-1) 


It  was  also  decided  that  the  cubic  term  of  Equation  (4-24)  be 
dropped.  This  term  is  only  of  signif icemce  far  away  from  the 
staging  event  (where  t  -  tatatfe  is  no  longer  small)  and  of 
maximum  concern  just  prior  to  a  staging  event.  As  this  algo¬ 
rithm  is  designed  to  process  a  small  number  of  data  points 
at  a  time  (Bayes  Filter)  in  order  to  aid  in  detection  of  a 
staging  event,  the  cubic  term  would  not  have  a  significant  a- 
mount  of  time  to  influence  the  estimation.  Therefore,  Equa¬ 
tion  (4-24)  can  be  rewritten  as: 


^rintrk  =  Ao  (t-tsnew  )2 
2 


(5-2) 


Equation  (4-33)  must  then  be  changed  to: 

(5-3) 
(5-4) 


[T]i  =  [  Hx  !  H2  ]i 


where 


Hi  =  -  1  (t-tsnew)2 


Hz 


Ve  o  1  d  M2  o  1  d 


( t-liSnew  )2 


Ao  {t— tsnew) 


2[l-Mol  d (tsnew-tsol d ]2 


(5-5) 


Once  the  conversion  of  the  necessary  matrices  is  accomplished 
the  algorithm  is  basically  identical  to  the  one  developed 
for  the  three-state  system. 

After  making  the  necessary  changes  to  the  staging  al¬ 
gorithm.  the  same  test  case  was  performed  with  much  better 
results.  Table  7  lists  the  covariance,  last  estimate  of  the 
state  at  convergence,  and  the  actual  values. 

Table  7  Covariance  and  Estimate  of  VeM  and  Tsta^e 

COVARIANCE  MATRIX  AT  TIME  OF  CONVERGENCE 

0.82116001614E+00  -0. 1843061 7242E-02 

-0 . 18430617242E-02  0 . 45527066070E-05 

ESTIMATION  OF  STATE  AT  C0NVEIM3ENCE 
VeM  tstage 

0 . 59200295714E+00  0 . 20473674506E+00 

ACTUAL  VALDES  FOR  STAGE  TWO 
0.986983965E+00  0 . 2045082036E+00 

Table  7  represents  the  output  of  the  staging  estimator  once 
it  has  achieved  convergence.  The  covariance  indicates  that 
the  value  of  VeM  is  not  known  as  well  as  the  staging  time 
but  the  values  do  reflect  a  much  better  estimate  than  the 
three-state  system  achieved.  With  the  results  of  the  two- 
state  system,  the  next  logical  step  was  to  pass  the  estimate 
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of  the  next  stage  parameters  back  to  the  Bayes  Filter  to  con 
tlnue  processing  sensor  data. 


Reentering  the  Bayes  Filter  Algorithm 

The  procedure  for  reentering  the  Bayes  Filter  outlined 
in  Chapter  4  was  accomplished.  Table  8  represents  the  typi¬ 
cal  problems  encounterd  by  the  Bayes  Filter  in  estimating 
the  state  vector  (Equation  (3-1))  components  involving  the 
launch  vehicle  parameters  (Ve  and  M)  of  the  next  stage.  The 


Table  8  Convergence  of  Main  Filter  After  Staging 


COVARIANCE 

OF  Ve  AND  M 

0.13050()7E+00 

-0.1032639E+00 

-0.1032639E+00 

0.1348049E+00 

STATE  ESTIMATE 

AT  CONVERGENCE 

Ve 

M 

0.7725107E+00 

0.1300567E+01 

EXACT 

VALDES 

0.3941439E+00 

0.2504121E+01 

estimated  values  of  exhaust  velocity  and  mass  ratio  passed 
back  to  the  main  loop  by  the  staging  estimator  represents  an 
initial  value  for  estimation  of  the  state  vector  (Equation  (3 
1))  for  the  next  stage.  The  initial  value  of  exhaust  veloci¬ 


ty  and  mass  ratio  was  chosen  by  assuming  the  exhaust  velocity 
to  be  the  same  as  the  previous  stage  and  dividing  the  estima¬ 
ted  product  by  the  exhaust  velocity  to  compute  the  initial 


value  for  the  mass  ratio.  The  problem  encountered  seems  to 
indicate  that  the  Bayes  Filter  had  little  idea  as  to  the  val¬ 
ues  of  stage  two  exhaust  velocity  cuxd  mass  ratio.  With 
this  in  mind,  it  was  left  to  devise  an  alternative  means  to 
reenter  the  Bayes  Filter. 

Noting  that  the  staging  estimator,  after  convergence, 
represents  an  estimate  of  the  product  VeM  with  an  associated 
covariance  matrix,  it  was  decided  to  take  advantage  of  the 
errors  associated  with  the  staging  estimator.  Since  the  co- 
variance  matrix  is  an  indication  as  to  how  much  the  state 
vector  can  be  "trusted"  (reference  5),  a  method  was  devised 
to  alter  the  covariance  matrix  of  the  main  Bayes  Filter. 

This  will  indicate  to  main  Bayes  Filter  that  the  values  of 
Ve  and  M  of  the  next  stage  are  no  longer  as  reliable  as  the 
first  stage  values  were.  Representing  the  estimate  of  the 
mass  ratio  to  the  Bayes  Filter  as 

Nbew  =  [  Ve  M  ]new  (5-6) 

Void 

and  recalling  the  procedure  for  finding  the  error  associated 
with  multiple  estimates  ((^apter  4),  the  differential  of 
Equation  (5-6)  is  computed  as: 

6  (Ve  M)aew  (Ve  H)iiee 

<5(ffaeM)  =  -  -  -  ^(Veold)  (5-7) 

Veold  (Veold)2 

Squaring  both  sides  of  Equation  (5-7)  yields: 
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[  b  (VeH)new]2  (VeM)2new 

[  b  (tfccw)]2  =  -  +  -  [  b  (Veold)]2 

(Veold)2  (Veold)^ 


2  (VeM)n«w  [  b  (Veold)]  [  b  (VeM)ne»]2 


(Veold  2 


(5-8) 


Applying  the  expectation  operator  (E)  and  neglecting  cross 
terms  leaves : 


<T2m  =  [  <T  2ve*  new  + 


(  VeM)2new 
(Veold  )2 


a  2veold  ] 


(5-9) 

Equation  (5-9)  represents  the  error  associated  with  the  esti 
mate  of  the  mass  ratio  to  be  passed  back  to  the  Bayes  Filter 
to  start  stage  two  data  processing.  The  error  associated 
with  the  estimate  of  the  exhaust  velocity  is  estimated  as 
twice  the  existing  value.  It  was  also  decided  that  the 
Bayes  Filter  segment  after  the  staging  event  be  allowed  to 
process  more  data  points  to  estimate  the  state  better. 
Appendix  F  represents  the  results  of  the  procedure  just  dis¬ 
cussed.  It  represents  a  much  better  estimate  of  the  state 
vector  (Equation  (3-1))  for  the  second  stage. 


The  Observabilit 


The  many  procedures  and  cases  that  were  attempted  seem 
to  all  have  the  same  basic  problem.  In  all  instances,  the 
last  two  components  of  the  state  vector  (Ve  and  M),  have 
caused  problems  for  the  estimator.  Capt.  Gross,  in  his  paper 


(reference  2),  stated  that  a  better  approach  may  be  to  esti¬ 
mate  the  product  VeM  since  it  appears  as  a  product  in  all  in 
stances,  and  also  estimate  the  mass  ratio  since  it  does 
appear  in  the  denominator  of  Equation  (2-8).  Although  this 
chamge  may  be  of  some  help  to  the  main  portion  of  the 
Bayes  Filter,  it  would  not  seem  to  help  the  staging  estima¬ 
tor  since  the  next  stage  mass  ratio  does  not  appear  in  the 
dynamics  alone.  The  cubic  term  that  appears  in  Equation  (4- 
24),  although  it  does  contain  the  multiple  product  term 
(VeNEW  Mhbw2),  is  not  utilized.  Since  the  data  available  to 
estimate  the  staging  state  vector  (in-track  residuals)  is  a 
relatively  small  segment  of  the  sensor  data,  the  cubic  term 
is  not  evaluated  for  a  long  enough  time  period  to  be  of  any 
use.  This  is  due  to  the  fact  that  the  main  algorithm  was 
designed  to  process  small  segments  of  data  (Bayes  Filter)  in 
order  to  isolate  the  staging  event  for  detection.  Capt. 
Vallado,  in  his  paper  (reference  4),  encountered  the  same 
problem  to  some  degree.  The  Bayes  Filter  had  a  difficult 
time  estimating  the  state  to  convergence  unless  the  initial 
value  contained  some  degree  of  accuracy.  In  most  cases,  the 
launch  point  of  the  vehicle  being  known,  the  position  and 
velocity  components  of  of  the  state  vector  can  be  estimated 
with  the  proper  degree  of  accuracy.  As  the  vehicle  is,  in 
most  cases,  of  an  unknown  type,  the  exhaust  velocity  and  the 
mass  ratio  will  not  be  estimated  with  the  seune  degree  of  ac¬ 
curacy.  If  the  initial  value  deviated  from  the  exact  value 


in  the  fourth  or  fifth  decimal  place,  the  last  two  components 
of  the  state  vector  would  try  to  drastically  correct  itself 
and  the  estimator  would  fail.  As  seen  in  Appendix  F,  the 
portion  of  main  filter  covariance  corresponding  to  the  mass 
ratio  and  exhaust  velocity  are  several  orders  of  magnitude 
larger  than  the  errors  associated  with  the  velocity  and  posi¬ 
tion  components.  This  would  tend  to  support  the  observabili¬ 
ty  problem  theory. 

A  further  case  was  considered  using  noisy  data.  The 
data  was  generated  using  the  nrathods  as  outlined  in  Chapter 
2.  While  the  estimator  was  attempting  to  converge  on  the 
noisy  data,  it  failed  after  two  iterations.  The  last  two 
estimates  of  the  state  would  drastically  change  amd  the  es¬ 
timator  would  fail.  This  problem  persisted  even  when  the 
"random"  noise  added  to  the  observation  data  was  decreased. 
Upon  starting  the  estimator  with  the  exact  values,  it  still 
failed  after  only  one  more  iteration. 


Conclusion 

In  this  paper,  the  estimation  of  ICBM  performance  para¬ 
meters  was  investigated.  Specifically,  the  detection  of  a 
staging  event,  estimation  of  next  stage  vehicle  parameters 
including  staging  time,  and  subsequent  estimation  of  next 
stage  performance  parameters.  While  the  detection  of  the 
staging  event  was  successful,  it  was  quite  apparent  that  a 
problem  existed  determining  the  exhaust  velocity  (Ve)  and 
mass  ratio  (M)  independently.  Much  more  success  was  achieved 


by  estimating  the  product  of  the  two  parameters.  This  prob¬ 
lem  was  also  encountered  in  the  main  Bayes  Filter  developed 
by  Capt.  Vallado  (reference  4).  If  the  initial  estimate  of 
the  state  was  not  of  at  least  fourth  place  accuracy,  the  es¬ 
timator  failed. 

Recommendations  for  further  study  would  be  to  redefine 
the  main  state  vector  to  include  the  product  of  exhaust 
velocity  and  mass  ratio  instead  of  the  present  configuration. 
This  would  involve  the  redesign  of  the  Bayes  Filter  developed 
by  Capt.  Vallado  (reference  4).  Once  this  has  been  accomp¬ 
lished,  methods  could  be  developed  to  make  use  of  the  esti¬ 
mated  product  of  exhaust  velocity  and  mass  ratio  to  gain  any 
launch  vehicle  parameter  information. 
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APPENDIX  A 


TROTH  MODEL  PROGRAMS 
Description 

The  purpose  of  this  program  is  to  provide  the  simulated 
sensor  data  needed  for  checkout  of  the  Bayes  Filter  estimator 
as  listed  in  Appendix  E.  It  accomplishes  this  by  numerically 
integrating  the  equations  of  motion  as  developed  in  Chapter  2. 
A  brief  description  of  the  subroutines  for  this  program  are  as 
follows: 

LSTIME 

Calculates  the  local  sidereal  time  for  the  sensor  sites. 

RADST 

Calculates  the  position  vector  of  the  sensor  site.  If  a 
land  based  sensor  is  chosen,  the  user  is  asked  to  input  the 
longitude  and  latitude  in  degrees  and  the  elevation  in  DU’s. 

If  a  space  based  sensor  is  chosen,  the  user  is  asked  to  input 
the  orbital  elements  as  described  in  Capter  2. 

RANDV 

Calculates  the  position  and  velocity  vectors  given  the 
initial  orbit  data.  The  subroutine  uses  the  eccentric  ano- 
moly  calculation  and  the  Nevrton  Raphson  method  to  find  the 
mean  anomoly. 

MAG 

Computes  the  magnitude  of  a  vector. 

CROSS 

Computes  the  cross  product  of  two  vectors. 


Hamlng 

This  subroutine  is  a  fourth  order  differential  equations 
integrator.  It  carries  four  copies  of  the  state  vector  along 
It  then  extrapolates  them  to  find  the  next  value.  It  then 
corrects  the  answer  to  find  the  new  value  of  the  state  vec¬ 
tor.  A  more  detailed  description  is  contained  in  Capt. 
Vallado’s  thesis  (reference  4). 

RHS 

Calculates  the  equations  of  motion  and  equation  of  var¬ 
iation  for  the  problem  being  evaluated.  It  is  only  used  as 
a  data  source  for  the  Haming  subroutine. 

VEHD 

Contains  the  algorithm  to  simulate  the  staging  of  an 
launch  vehicle. 

RAZEL 

Computes  the  sensor  data  (  p.  az,  el)  from  the  7  vector 
as  computed  by  the  numerical  integrator.  Also  contains  the 
algorithm  to  compute  the  transformation  matrices  as  defined 
in  Chapter  2. 
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PROGRAM  TRUTH 


THE  COMMON  TERMS 

COMMON  /HAM/  T,Y<72,4) ,F(72,4) ,ERR<72) ,N,DT,MODE,TEPOCH 
DOUBLE  PRECISION  T,Y,F,ERR,DT,TEPOCH 
INTEGER  N,NXT,MODE 

ALL  OTHER  VARIABLES 

INTEGER  NIT,INA,INB,INCC,IND,INE,INF,INO 
DOUBLE  PRECISION  SI6AZ,LP,LLAT,LL0N,LRS(0:3) , IVEL, 

LLST,RAD,TP,RH0,AZ,EL,T0,BSEED,SIGRH0,LVV(0:3),NUDGE, 

R<0;3),V<0:3),RS(0:3),RCV(0;3),TRM(3,3),SIGEL, 

RM(0;3), VM(0J3), DOT, GAMMA, TM 
CHARACTER  TYPE,ANS, TYPED 

BEGIN  THE  PROGRAM 

F0RMAT<6X,'R  <KM)',8X,'V  (FT/SEC) AX, 'GAMMA  <DEB)',6X, 

'TIME  <SEC)',4X,'VE  <DU/TU) ' ,4X, 'M  ') 
F0RMAT<2X,4E20.13,/,2X,4E20.13,/,2X,'THE  INITIAL  TIME  IS  ', 

FA. 4) 

F0RMAT<2<1X,F14.A),4(2X,F14.10)) 

F0RMAT(9X,'X',12X,'Y',12X,'Z',10X,'XD0T',9X,'YD0T',9X, 

'ZDOT',10X,'VE',10X,'M') 

OPEN  <UNIT=17,FILE*'PR0DUCT',ACCESS='SE0UENTIAL',STATUS='NEU') 
OPEN  <UNIT=14,FILE='TDATA',ACCESS»'SEQUENTIAL',STATUS='NEU') 

RAD=3.141592A5359D  +00/180. OB  +00 

NXT=1 

M0DE=0 

N=8 

INPUT  INITIAL  DATA 

PRINT*, 'INPUT  THE  LENGTH  OF  THE  FLIGHT  IN  SECONDS,  AND  TIME' 

READ*,TP,TEPOCH 

T=TEPOCH 

PRINT#, 'INPUT  STATE  VECTOR,  OR  HAVE  IT  CALCULATED, Y  OR  N' 
READ*, TYPED 

IF  (TYPED.EQ.'Y')  GOTO  5 
IF  <TYPED.EQ.'N')  GOTO  7 

PRINT*, 'INPUT  THE  INITIAL  STATE  VECTOR  FOR  THE  VEHICLE' 
READ*,Y<1,NXT),Y<2,NXT),Y(3,NXT),Y(4,NXT),Y{5,NXT),Y(A,NXT), 
Y<7,NXT),Y(8,NXT) 

IF  (TYPED.EQ.'N')  THEN 

PRINT*, 'LAUNCH  SITE  POINTS  ARE  AS  FOLLOWS’.' 


■  _  *•  w  "•  . 


PRINT#, '0  PETROPAVLOVSK  53. 7N  158. 2E' 

PRINT#, '1  yiAIDIVOSTOK  43. 5N  132. OE' 

PRINT#, '2  TURYANTUNUM 
PRINT#, '3  PLESEK 

PRINT#, 'INPUT  THE  LAUNCH  POINT  NUMBER' 

REAIi#,LP 

IF  (LP.EQ.O)  THEN 
LLAT=53.7D+00#RAD 
LL0N=158.2D400#RA0 
END  IF 

IF  (LP.EQ.l)  THEN 
LLAT=43.5D+00#RAD 
LL0N=132.0Ii+00#RAD 
END  IF 

IF  <LP.EQ.2)  THEN 
LLAT=1.0D+00#RAD 
LL0N=1.0D+00#RAD 
END  IF 

IF  <LP.EQ.3)  THEN 
LLAT=1,0D+00#RAD 
LL0N=1.0D400#RAD 
END  IF 

LRS<0)=1.0D+00 

CALL  LSTIME<LLST,T,TO,LLON> 

ANS='L' 

C ALL  RADST < LRS , LL AT , LLST , T , TO , ANS , I NO ) 

IN0»O 

PRINT#, 'INPUT  INITIAL  VELOCITY  IN  FT/S' 

READ#,IVEL 

IVEL=IVEL/25936.247&4D+00 
DO  40  INR=1,3 

40  LVV<INR)=IVEL#LRS<INR) 

PRINT#, 'HOW  MUCH  DO  YOU  WANT  TO  NUDGE  THE  VELOCITY' 
READ#, NUDGE 

LVV(3)=LVV<3)+LVV<3)#NUDGE 
DO  44  INW=1,3 

Y(INW,NXT)=LRS<INW) 

Y<INW+3,NXT)=LVV(INW) 

44  CONTINUE 

END  IF 

TP=TP/806.8118744D+00 

PRINT#, 'INPUT  THE  NUMBER  OF  ITERATIONS' 

READ*, NIT 
DT-TP/NIT 
NXT=0 

C  WRITE  INITIAL  HEADER  DATA 

URITE(17,*)  'THE  INITIAL  STATE  VECTOR  FOR  THE  MISSILE  IS' 
WRITE(17,12) 


INB=0 


6.1 


[iSEED=B88B8.D-l-00 

SIGRH0=l.0D-8 

SIGAZ=1.0D-04 

SIGEL=1.0D-04 

TYPE='N' 


C  INITIALIZE  NAMING  AND  RESET  THE  TIME 

NXT=0 

CALL  HAMING<NXT) 

T=TEPOCH 

IF  (NXT.EQ.O)  STOP 

URITE(17,4)  (Y<INF,NXT),1NF=1,0),T 

PRINT*, Y<1,NXT),Y<2,NXT),Y(3,NXT),Y(4,NXT),Y(5,NXT),Y<6,NXT), 
+  Y(7,NXT),Y<8,NXT) 

PRINT*, 'Y=', Yd, NXT)*A378*145D+00,Y<2,NXT)*A378. 14511+00, 

+  Y ( 3 , NXT ) *6378 . 1 45D+00 , Y ( 4 , NXT ) *7 . 9053A828D+00 

PRI NT* , ' Y= ' , Y ( 5 , NXT ) *7 . 9053&82BD+00 , Y ( 6 , NXT ) *7 , 9053&28D+00 , 

+  Y<7,NXT),Y<8,NXT) 

WRITE<17,2) 

C  BEGIN  LOOP  TO  INTEGRATE 

DO  10  INCC=0,NIT 

CALL  HARING (NXT) 

INB*INB+1 
DO  30  IND=1,3 

R(IND)=Y<IND,NXT) 

V(1ND)=Y<IND+3,NXT) 

30  CONTINUE 

CALL  RAZEL(R,V,RHO,AZ,EL,TO,T,RS,TRM,INO) 

IF  (lOH.NE.lO)  THEN 

PRINT*, 'DO  YOU  WANT  NOISY  DATA,  Y  OR  N' 

READ*, TYPE 

IF  (TYPE.EQ.'Y')  THEN 

PRINT*, 'INPUT  A  SEED  NUMBER  FROM  1-21483647D+00' 
READ*,DSEED 
END  IF 
I0H=10 
END  IF 

IF  (TYPE.EQ.'Y')  THEN 

RHO=RHO+GGNOF ( DSEED ) *SI GRHO 
AZ=AZ+GGNGF(DSEED)*SI6AZ 
EL=EL+GGNQF( DSEED )»SIGEL 
END  IF 

URITE(14,*)  RHO,AZ,EL,T 

IF  (INB.EQ.IO)  THEN 
DO  34  INS=1,3 

RM ( I NS ) =R ( I NS ) *6378 . 1 45D+00 
VM(INS)=V(INS)*25936.2647D+00 
34  CONTINUE 

CALL  MAG(R) 
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CALL  MAG(RM) 

CALL  MAG(Vh) 

CALL  MAG<V) 

D0T=R(1)»V(1)+R<2)*V<2)4R(3)*V(3) 

GAMMA=DACOS  <  DOT / ( R ( 0 ) <  0 ) ) ) 

TM=T*80&»8118744D400 

WRITE<17,A)  RH<0),VM<0), GAMMA/RAD, TM,Y<7,NXT),Y<8,NXT) 

INB=0 
END  IF 

IF  (INCC.EQ. NIT-1)  THEN 
PRINT  OUT  FINAL  DATA 

PRINT*, 'THE  FINAL  VALUES  FOR  R  AND  V  ARE!' 

PRI NT* , ' Y= ' , Y ( 1 , NXT ) *6378 . 1 45D400 , Y ( 2 , NXT ) *6378 . 1 45D400 , 

Y  <  3 , NXT ) *6378 . 1 45D400 , Y ( 4 , NXT ) *7 . 90536828D400 
PRI NT* , ' Y= ' , Y ( 5 , NXT ) *7 . 90536828D400 , Y ( 6 , NXT ) *7 . 90536828D400 
Y<7,NXT),Y(8,NXT) 

WRITE(17,12) 

WRITE<17,4)  (Y(INF,NXT),INF=1,8),T 
WRITE<17,*) 

END  IF 

CONTINUE 

ENDFILE<UNIT=17) 

ENDFILE<UNIT=14) 

END 

SUBROUTINE  LSTIME<LST,T,TO,LON) 

DOUBLE  PRECISION  LST,T,TO,LON 
DOUBLE  PRECISION  THTGO,TWOPI,GST 
T0=0,OD40O 

TW0PI=6.28318530718D400 

THTGO=98.85481D400*(3.14159265359D400/180.00D400) 

GST=THTG041 .0027379093D400*( (T*13,44686457D400/ 

1440.0D400)-T0) 

6ST=DM0D<GST,TU0PI) 

LST=GST4L0N 

LST=IlMOD<LST,TUOPI) 

RETURN 

END 

SUBROUT I NE  R ADST ( RS , L AT , LST , T , TO , ANS , I NO ) 

DOUBLE  PRECISION  RS<0:3) ,LAT,LST,T,TO 


CHARACTER  ANS 


DOUBLE  PRECISION  STA,STE,STI ,ST0MGA,STARGP,STV(0:3) ,STM,STN, 
STNUO 


INTEGER  INO 

LAND  BASED  SENSOR 

IF  (ANS.EQ.'L')  THEN 
IF  <INO.EQ.O)  THEN 

PRINT*, 'INPUT  THE  ELEVATION  OF  THE  SITE' 
READ«,RS(0) 

IN0=10 
END  IF 

RS ( 1 ) =RS  <  0 ) »DCOS ( LAT ) *DCOS  <  LST ) 
RS<2)=RS(0)*DC0S(LAT)«DSIN<LST) 
RS<3)=RS<0)*DSIN<LAT) 

RETURN 


END  IF 


SPACE  BASED  SENSOR 

IF  (ANS.EQ.'S')  THEN 
IF  (INO. EG. 0)  THEN 

PRINT*, 'INPUT  THE  TRACKING  SAT  ORBIT  DATA,  A,  E,  I,  OMEGA,  ARGP' 
READ* , ST A , STE , STI , ST0M6A , ST ARGP 
END  IF 

STN=DSQRT (1 / <  STA*ST A*STA ) ) 

STM=STN*<T-TO) 

CALL  RANDV ( STA , STE , STI , STOMGA , ST ARGP , STNUO , STM , RS , STV ) 

CALL  MAG(RS) 

IF  (INO. EG. 0)  THEN 

F0RMAT(3X, 'A' ,6X, 'E' ,&X, ' I ' ,5X, 'OMEGA' ,3X, 'ARGP' ,4X, 'M' ) 
F0RMAT(6(1X,F6.3)) 

WRITE(17,*) 

WRITE(17,*)  'THE  TRACKING  SATELLITE  DATA  IS' 

WRITE(17,A4) 

WRITE ( 17 , 66)  STA, STE , STI , STOMGA , STARGP , STM 
IN0=10 
ENli  IF 


END  IF 

RETURN 

END 

SUBROUTINE  RAND V(A,E, INC, OMEGA ,AR6P,NU0,M,R,V) 

DOUBLE  PRECISION  A, E, INC, OMEGA, ARGP, NU0,M,R(0:3),V(0:3) 

DOUBLE  PRECISION  RAD,P,EL,EO,MO 

RAD=3.1415926S359D+00/180.00D+00 

MO-M*RAD 


INC=INC*RAD 

ARGP=AR6P«RAD 

0NE6A=0HE6A»RAD 

P=Ai|t(l-E»E) 

NEUTON  RHAPSON  ITERATION 


EL=MO 

EO=EL 

EL=EO- <  EO-E*nsiN  <  EO ) -MO )/ ( 1 . 0D+00-E»DC0S ( EO ) ) 

IF  <DABS<EL-E0).6T.1.0D-12)  THEN 

EL=EO-  <  EO-E*DSI  N  <  EO )  -MO )  /  <  1 ,  OD+OO-EHtDCOS  ( EO ) ) 
PRINT*, 'EL=', EL 
GOTO  8 
END  IF 


FIND  THE  VALUE  OF  THE  TRUE  ANOMALY 

NU0=nATAN2  <  <  DSQRT  <  1  ♦0Ii+00-E*E ) )  »DSIN  ( EL )  /  <  1 ,  OD+OO-E* 
DCOS  <  EL ) ) , ( E-DCOS  <  EL ) ) / <  E»DCOS  <  EL ) - 1 , OD+00 ) ) 

POSITION  AND  VELOCITY  VECTORS 

R  ( 1)  -P*DCOS  <  NUO )  /  <  1 .  ODFOO-l-EtDCOS  ( NUO ) ) 
R(2)=R<l)«DTAN<NUO) 

R(3)=O.ODFOO 

V<l)=-DSIN<NUO)/IiSQRT(P) 

V ( 2 )  =  ( E+DCOS ( NUO ) ) /DSQRT  <  P ) 

V(3)=0,0D+00 

RETURN 

END 


SUBROUTINE  MAG<RX) 

DOUBLE  PRECISION  RX<0:3) 

RX<0)=DSQRT<RX<1)»RX<1)+RX<2)»RX<2)+RX(3)*RX(3)) 

RETURN 

END 


SUBROUTINE  CROSS(RIN,VIN,VX) 

DOUBLE  PRECISION  RIN<0:3) ,VIN(0:3) ,VX(0:3) 

VX<1)=RIN<2)*VIN<3)-VIN<2)*RIN(3) 

VX<2)=-RIN<1)»VIN<3)+VIN<1)»RIN(3) 

VX<3)=RIN<1)«VIN(2)-VIN<1)«RIN<2) 

CALL  MAG<VX) 

RETURN 

END 


SUBROUTINE  HAMING<NXT) 


COMMON  /HAM/T , Y ( 72 , 4 ) , F  <  72 , 4 ) ,ERREST ( 72 ) , N , DT , MODE , TEPOCH 


DOUBLE  PRECISION  T,Y,F,ERREST,DT, TEPOCH 
INTEGER  N,MODE,NXT 

INTEGER  IDA, IDB, IDC, IDD, IDE, IDF, IDG, IDH, IDI , IDJ, IDK, IDL, IDM, IDN 

DOUBLE  PRECISION  TOL,HH,XO 

THE  VARIABLES  ARE  USED  AS  FOLLOWS 
T 

Y<72,4) 

F<72,4) 

ERREST 
N 

DT 

MODE 

T0L=1,0D-12 
IF  <NXT)  190,10,200 

SWITCH  ON  STARTING  ALGORITHM  OR  NORMAL  PROROGATION 
THIS  IS  HAMINGS  STARTING  ALGORITHM. , .A  PREDICTOR-CORRECTOR 
NEEDS  4  VALUES  OF  THE  STATE  VECTOR  ,  AND  YOU  ONLY  HAVE  1,  THE 
l.C.  HAMING  USES  PRICARD  ITERATION  <SLOW  AND  PAINFULL)  TO  GET 
THE  OTHER  THREE* 

IF  IT  FAILS,  NXT=  0  ON  EXIT,  OTHERWISE,  NXT=1,  AND  IT'S  OK. 


INDEPENDENT  VARIABLE  (TIME) 

STATE  VECTOR  IN  4  COPIES 
EQUATIONS  OF  MOTION,  4  COPIES 

CALL  RHS(NXT)  UPDATES  ENTRY  IN  F 
ESTIMATE  OF  TRUNCATION  ERROR 
NUMBER  OF  EQUATIONS  BEING  INTEGRATED 
TIME  STEP 

0  FOR  EOH.  1  FOR  EOM  AND  EOV 


XO»T 

HH=DT/2.0D+00 
CALL  RHS(l) 

DO  40  IDA=2,4 
T=TfHH 

DO  20  IDB=1,N 

Y(IDB,IDA)=Y(IDB,IDA-l)+HHi|[F(IDB,  IDA-1) 

CONTINUE 
CALL  RHSdDA) 

T=TFHH 

DO  30  IDC=1,N 

Y(IDC,  IDA)=Y(IDC,  IDA-1  )+DT!|tF(IDC,  IDA) 

CONTINUE 
CALL  RHSdDA) 

CONTINUE 

IDD=-10 

IDE=1 

DO  120  IDF«1,N 

HH=YdDF,l)+DT«<9.0D+00«FdDF,l)  +  19.0D+00»FdDF,2)- 
5.0D+00liFdDF,3)+FdDF,4))/24,0D+00 
IF  <DAB8<HH-YdDF,2)).LT.T0L)  GOTO  70 
IDE=0 

YdDF,2)=HH 

HH*YdDF,l)+DT*<FdDF,l)+4.0D+00*FdDF,2)+FdDF,3))/3.0D+00 


IF  (DAIiS(HH-Y(IDF,3)).LT.T0L)  GOTO  90 
IDe»0 

Y(IDF,3)=HH 

HH= Y  <  I DF ,  1 )  +DT1II  ( 3 . 0ri+00*F  ( I DF ,  1 )  +9 . 0D+00»F  <  IDF ,  2 )  + 

9 , 0D+00#F  < I DF , 3 ) +3 . 0D+00*F  < IDF , 4 ) ) /8 . OD+00 
IF  (DABS<HH-Y<IDF,4)).LT.T0L)  GOTO  110 
IDE=0 

Y<IDF,4)=HH 

CONTINUE 

T=XO 

DO  130  IDG=2,4 
T=Tm 

CALL  PHS<IDG) 

CONTINUE 

IF  (IDE)  140,140,150 
IDD=I00F1 

IF  (IDD)  50,280,280 

T=XO 

IDE=1 

IDD=1 

DO  lAO  IBH=1,N 
ERREST<IDH)=0.0 
CONTINUE 
NXT=1 
GOTO  280 
IDD=2 

NXT=IADS<NXT) 

THIS  IS  MAKINGS  NORMAL  PROPAGATION  LOOP 
T=T+DT 

IDL=M0D<NXT,4)t1 
GOTO  <210, 230), IDE 

PERMUTE  THE  INDEX  NXT  MODULO  4 

GOTO  <270, 270, 270, 220), NXT 
IDE=2 

IDI=M0D<IDL,4)+1 

IDJ=M0D<IDI,4)+1 

IDK=M0D<IDJ,4)+1 

THIS  IS  THE  PREDICTOR  PART 

DO  240  IDM=1,N 

F<IDM,IDI)=Y<IDM,IDL)+4,OD+OO»DT#<2,0D+OO»F<IDM,IDK) 
F ( IDM, IDJ) +2 ,0D+OO*F  < IBM, IDI ) ) /3 .OD+00 
Y  < I DM , I DL ) =F  < IDM , I DI ) -0 . 925619B35D+00*ERREST  < I DM ) 
CONTINUE 

NOU  THE  CORRECTOR  -  FIX  UP  THE  EXTRAPOLATED  STATE 
BASED  ON  THE  BETTER  VALUE  OF  THE  EQUATIONS  OF  MOTION 


CALL  RHS(IDL) 
DO  250  IDN=1,N 


Y  ( I DN ,  I DL )  =  ( 9 . 0Ii+00»Y  <  IDN ,  1 DK )  -  Y  ( I  UN ,  IIH )  +3 .  OD+OOtliT* 

+  (F  < IDN , IDL ) +2 .0D+00*F ( IDN , IDK ) -F (IDN , ID J ) ) ) /8 .OD+OO 

ERREST<IDN)=F(IDN,IDI)-Y(IDN,IDL) 

Y  (IDN ,  IDL )  =  Y  ( IDN ,  I DL  )+0 .074380 1653D+00i|iERREST  <  IDN ) 

250  CONTINUE 

GOTO  <260,270),IDD 
260  CALL  RHSdDL) 

270  NXT=IDL 

280  RETURN 

END 

SUBROUTINE  RHS(NXT) 

COMMON  /HAM/T,Y<72,4),F<72,4),ERR(72),N,DT,M0DE,TEP0CH 
DOUBLE  PRECISION  T,Y,F,ERR,DT,TEPOCH 
INTEGER  N,MODE,NXT 

INTEGER  IRA , IRB, IRC, IRD , IRE, IRF, IRG ,  IRH ,  IRI ,  IR J, IRK 

DOUBLE  PRECISION  R32,V32,VEL,VAT,WE,VEM,MASS,ACC,R52,AM(8,8) , 
+  MASSO,MDOT,VE,TSTAGE 

C  THIS  DATA  STATEMENT  HARDWIRES  THE  PARTS  OF  THE 

C  A  MATRIX  WHICH  ARE  NEVER  CHANGED  ...ONLY  THE  MIDDLE 

C  3  ROWS  CHANGE  EACH  TIME 

DO  10  IRA’^lrd 
DO  10  IRB=1,3 

AM<IRB,IRA)=0. OD+OO 
10  CONTINUE 

DO  20  IRC=1,8 
DO  20  IRD=7,8 

AN<IRD,IRC)=0. OD+OO 
20  CONTINUE 

AM<1,4)=1. OD+OO 
AM<2,5)=1. OD+OO 
AM(3,6)=1, OD+OO 

C  THE  BASIC  FUNCTION  OF  RHS  IS  TO  CALCULATE  THE  EQUATIONS 

C  OF  MOTION  (THE  F  ENTRIES)  FROM  THE  GIVEN  CURRENT  STATE 

C  (STORED  IN  Y)  AND  THE  TIME  T 

C  EVALUATION  OF  THE  EQUATIONS  OF  MOTION 

C  REFERENCE  BATES  MEULLER  I  WHITE,  PG  10,  N  BODY  PROBLEM 

C  WITH  ORIGIN  IN  SUN. 

C  POSITION  DOT  =  VELOCITY  VECTOR 

F(1,NXT)=Y(4,NXT) 

F<2,NXT)=Y(5,NXT) 

F(3,NXT)=Y(6,NXT) 
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C  VELOCITY  DOT  =  GRAVITY  ACCELERATION 

R32=(Y(1,NXT)»Y<1,NXT)+Y(2,NXT)*Y(2,NXT)+ 

+  Y(3,NXT)»Y<3,NXT))»«!l.5D+00 

VEL=(Y(4,NXT)«Y(4,NXT)+Y<5,NXT)*Y(5,NXT)+ 

+  Y(6,NXT)#Y(6,NXT))»».5D+00 

V32=VEL»«3.0Dt00 

C  SET  THE  CONSTANTS  UHICH  UILL  BE  USED  IN  THE  A  HATRIX 

XMU=1 ►ODtOO 
IF  (IRE.EQ.O)  THEN 

PRINT*, 'INPUT  THE  TYPE  OF  HISSILE  TO  BE  EVALUATED' 

PRINT*, 'THE  CHOICES  ARE  AS  FOLLOWS' 

PRINT*, 'SATELLITE  IN  ORBIT  O' 

PRINT*, 'TITAN-IIID  1' 

READ*,IRF 
IRE=10 
END  IF 

IF  (IRF.EQ.O)  THEN 
VVE*1.0D+00 
VEM=1.0D+00 
ACC=0.0D+00 
MASS=1.0D+00 
GOTO  6 
END  IF 

CALL  VEHD  <  VE , MDOT , MASSO , T , I RF , TEPOCH , TST AGE ) 

MASS=MDOT/MASSO 

VVE=VEL*VE 

VEM*VE*MASS 

ACC=VE*MASS/ ( 1 . OD+OO-MASS* ( T-TSTAGE ) ) 

Y<7,NXT)=VE 

Y<8,NXT)=MASS 

6  F  <  4 , NXT ) =-XMU*Y  < 1 , NXT ) /R32+ACC*Y ( 4 , NXT ) /VEL 

F ( 5 , NXT ) =-XMU*Y  <  2 , NXT ) /R32+ACC*Y  <  5 , NXT ) /VEL 
F  <  6 , NXT ) =-XMU«Y ( 3 , NXT ) /R32+ ACC*Y ( 6 , NXT ) / VEL 
F(7,NXT)=0,0Dt00 
F(8,NXT)=O.OD+O0 

C  END  OF  EQUATIONS  OF  MOTION 

C  IS  THIS  ALL  ? 

IF  (MODE.EQ.O)  RETURN 

IT  ISNT  ALL  ...  CALCULATE  THE  EQUATIONS  OF  VARIATION 
FIRST,  CALCULATE  A  MATRIX  ONLY  LOWER  3X3  ISNT  HARDWIRED 

R52=R32**<  5 . OD+00/3 , OD+00 ) 

C  DIAGONAL  TERMS  IN  A  MATRIX 

AM( 4 , 1 ) =-XMU/R32+3 , 0D+00*XMU*Y ( 1 , NXT ) *Y ( 1 , NXT ) /R52 
AM  <  5 , 2 ) =-XMU/R32+3 , 0D+0O*XMU*Y ( 2 , NXT ) *Y ( 2 , NXT ) /R52 
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AM  <  6  f  3 )  =-XMU/R32+3 .  OD+OOittXMU»Y  <  3 ,  NXT )  HtY  <  3 ,  NXT )  /R52 

OFF  DIAGONAL  TERMS  IN  A  MATRIX  USE  SYMMETRY  TO  AVOID 
AS  MUCH  CALCULATION  AS  POSSIBLE. . .THIS  POINT  IS  DEEP 
WITHIN  LOTS  OF  LOOPS! I  I ! 

AM ( 4 , 2 ) =3 . OD+O0#XMU* Y  < 1 , NXT ) *Y  <  2 , NXT ) /R52 
AM(5,1)=AM(4,2) 

AM ( 4 , 3 ) =3 . 0D+00»XMU»Y ( 1 , NXT ) *Y  <  3 , NXT ) /R52 
AM(4,1)=AM(4,3) 

AM  <  5 , 3 ) =3 . 0D+00*XMU*Y  <  2 , NXT ) »Y  <  3 , NXT ) /R52 
AM(&,2)=AM<Sf3) 

NOW  SOME  STUFF  FOR  THE  OTHER  TERMS 

AM  <  4 , 4 ) =- Y ( 4 , NXT ) * Y  <  4 , NXT ) ♦ACC/V32+ ACC/VEL 
AM  <  5 , 5 ) =- Y  <  5 , NXT ) *Y ( 5 , NXT ) tACC/ V32+ ACC/ VEL 
AM  <  6 1 6 ) =- Y ( A , NXT ) *Y  <  6 , NXT ) »ACC/V32+ ACC/VEL 

AM<4,5)=-Y<4,NXT)!|[Y(5,NXT)*ACC/V32 

AM(5,4)=AM(4,5) 

AM<4,A)=-Y(4,NXT)*Y<A,NXT)«ACC/V32 

AH<A»4)=AM(4,A) 

AM<5,6)=-Y(5,NXT)*Y<A,NXT)!|!ACC/V32 

AM(6,S)=AM(Sf6) 

AM<4,7)=Y(4,NXT)*ACC/VVE 
AM<  5 ,7 ) =Y  <  5 , NXT ) tACC/VVE 
AM  ( 6 , 7 )  =  Y  ( & ,  NXT )  DtACC/ VVE 

VAT=ACC»ACC*T/VEM+ACC/MASS 

AM<  4 , 8) =Y ( 4 , NXT ) *VAT/ VEL 
AM(5,8)=Y<5,NXT)»VAT/VEL 
AM  <  6 , 8 ) =Y ( 6 , NXT ) »VAT/ VEL 

THE  A  MATRIX  IS  NOW  CALCULATED 

NOW,  CALCULATE  PHI  DOT=A*PHI  AND  PUT  INTO  LAST 
64  SLOTS  OF  THE  F  MATRIX 

DO  800  IRG-1,8 
DO  800  IRH=1,8 
IRI=8*IRH+IRG 
F<IRI,NXT)=0.0D+00 
DO  700  IRJ=1,8 
IRK=8*IRH+IRJ 

F(IRI,NXT)=F<IRI,MXT)+AM(IRG,IRJ)*Y<IRK,NXT) 

CONTINUE 

CONTINUE 

PHI  DOT=A»PHI  IS  NOW  DONE 


RETURN 

END 


SUBROUT I NE  VEHD ( VE , MDOT , MASSO , T , I RF , TEPOCH , TST AGE ) 

DOUBLE  PRECISION  VE,MD0T,HASS0,T,TEP0CH,TSTA6E 
INTEGER  IRF 

DOUBLE  PRECISION  TINE, ISP, THRUST 

TINE-T*806, 81187440400 

IF  <IRF.EQ.l)  THEN 

IF  (TIME. LT. 165, OD+00)  THEN 
ISP=301,6D+00 
THRUST=531250,0D+00 
MASS0=410028.0D-l-00 
TSTAGE=TEPOCH 
VE=ISP/806 , 81 18744D+00 
MDOT=THRUST/VE 
END  IF 

IF  < (TIME. LT. 375. OD+00). AND. (TIME, GE, 165. OD+00))  THEN 
ISP=318.0D400 
THRUST= 100700,00+00 
MASS0=102028.0D+00 
TST A6E= 1 65 . OD+00/806 .811 8744D+00 
VE=ISP/806.8118744D+00 
MDOT=THRUST/VE 
END  IF 

IF  ( (TIME. LT. 520. 4D+00). AND. (TIME. GE. 375. OD+00))  THEN 
ISP=295,0D+00 
THRUST=42200,0D+00 
MASSO=24028.0D+00 
TSTAGE=375 . OD+00/806 .811 8744D+00 
VE=ISP/806 , 81 18744D+00 
MDOT=THRUST/VE 
END  IF 

IF  (TIME  .GT.  520.4)  THEN 
MASS0=2628.0D+00 

TSTAGE=520 . 4D+00/806 . 81 1 8744D+00 

VE=0,0D+00 

MD0T=0,0D+00 

END  IF 
END  IF 

RETURN 

END 

SUBROUTINE  RAZEL(R,V,RHO,AZ,EL,TO,T,RS,TRM) 

DOUBLE  PRECISION  R(0:3) ,V(0:3) ,RHO, AZ,EL,T0,T,RS(0;3) ,TRM(3,3) 

DOUBLE  PRECISION  LAT,L0N,LST,ZVEC(0;3) ,SVEC(0;3) ,EVEC(0:3) ,RAD, 
+  RHOVE(0;3),KVEC(0:3),RHOVEC(0:3),RE(0:3),RSE(0:3) 


INTEGER  ING,INH,INI,INJ,INK,INL,INM,INN,INNL 


CHARACTER  ANS 
IF  (IN6.EQ.0)  THEN 

PRINT*, 'ENTER  SENSOR  TYPE,  LAND  OR  SPACE,  IN  QUOTES' 

READ*, ANS 

ING=10 

RAD=3.1415926535D+00/180.0D+00 
KVEC<l)=0.0D+00 
KVEC(2)=0,OD+00 
KVEC(3)=1.0D+00 
END  IF 

IF  (<ANS.EQ.'L').AND.<INH.EG.O))  THEN 

PRINT*, 'INPUT  THE  LAT  AND  LON  OF  SITE  IN  DEG,  EAST+,WEST 
READ*, LAT, LON 
LAT=LAT*RAD 
LON=LON*RAD 
INH=10 
END  IF 

CALL  L6TIHE<LST,T,T0,L0N) 

CALL  RADST  <  RS , L AT , LST , T , TO , ANS , I NO ) 

DO  100  INI=1,3 

RHOVE<INI)=R<INI)-RS(INI) 

CONTINUE 
CALL  MA6<RH0VE) 

RH0=RH0VE(0) 

SET  UP  LOCAL  COORDINATE  SYSTEM 

DO  no  INJ=1,3 

ZVEC<INJ)=RSaNJ)/RS(0) 

CONTINUE 

CALL  CROSS(KVEC,ZVEC,EVEC) 

DO  112  INM=1,3 

EVEC  < INM ) =EVEC  < INM ) /E VEC ( 0 ) 

CONTINUE 

CALL  CROSS<EVEC,ZVEC,SVEC) 

DO  114  INN=1,3 

SVEC ( 1 NN ) =SUEC  < INN ) /SVEC ( 0 ) 

CONTINUE 

SET  UP  THE  TRANSFORMATION  FOR  UK  =  TRM*SEZ 

DO  120  INL=1,3 

TRM(INL,1)=SVEC<INL) 

TRM(INL,2)=EVEC(INL) 

TRM(INL,3)=ZVEC<INL) 

CONTINUE 
DO  121  INNL=1,3 


RE<INNL)=R<INNL) 

RSE(INNL)=RS(INNL) 

CONTINUE 

CONVERT  TO  SEZ  FOR  CALCULATIONS 
DO  130  INK=1,3 

RHOVEC (INK) =RHOUE  < 1 ) #TRM< 1 , 1 NK ) +RHOVE ( 2 ) *TRM ( 2 , INK ) 
+RH0VE<3)*TRM(3,INK) 

NOTE!!!  HERE  ME  DO  NOT  TRANSFORM  R  TO  SEZ  SINCE  UE  WILL  NOT 
BE  CALCULATING  H  AS  IN  OBSER!!!! 

RS<INK)=RSE<1)*TRM(1,INK)+RSE(2)»TRM(2,INK) 

+RSE<3)»TRM<3,INK) 

CONTINUE 

IF  (RH0VEC<l).EQ.0.0D+00)  THEN 

IF  (RH0VEC(2).GT.0.0D+00)  AZ=90.0D+00*RAD 
IF  (RH0VEC<2).LT.0.0D+00)  AZ=270.0D+00«RAD 
IF  <RH0VEC<2).EQ.0.0D+00)  THEN 
AZ=0,ODFOO 

IF  <RH0VEC(3).GT.0.0D+00)  EL=90,0D+00*RAD 
IF  (RH0VEC(3).LT.0.0n+00)  EL=-90.On+OOH!RAD 
END  IF 
END  IF 

IF  ((RHOVEC<l).NE.O.OD+OO),AND.(RHOVEC(2),NE.0.OD+OO))  THEN 
AZ=DAT AN  <  RHOVEC ( 2 ) /RHOVEC ( 1 ) ) 

EL=DAT AN  <  RHOVEC ( 3 ) /DSQRT ( RHOVEC ( 1 ) CRHOVEC ( 1 >  +RHOVEC ( 2 ) * 
RH0VEC<2))) 

IF  < RHOVEC (1),LT.O.OD+O0)  AZ=AZ+lBO.0D+OO*RAD 
IF  <<RHOVEC(l).6T.O.OD+OO),AND.(RHOVEC<2),LT.O.0D+OO))  AZ 
AZ+360,0D+00#RAD 

END  IF 


RETURN 


whore 


v»,vy,v*  =  volocity  componen-bs  of  velocity  vector 
M  =  mass  ratio  (  m  /  mo  ) 

Ve  =  exhaust  velocity 
a  =  as  defined  in  Equation  (2-8) 
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Pick  xref(to),  Ini'bial  guess  for  state  vector 

Set  Q  and  read  in  data  for  all  observations  (G) 

Initialise 
0=1 
P-»  =  0 
TT^ir  =  0 

For  each  observation  tine 

-  Bove  Use  (to  )  to  xr«r  (ti  ) 

Hamlng  and  rhs  do  this  for  ,  also  0 

calculate  predicted  data  using  Iber (ti ),  zpred 
calculate  residual  ri  =  zi  ~  zpredi 
calculate  H 
calculate  T  =  H0 
SUB  X  TT  Q- 1 T 

-  sum  X  IT  Q- 1  r 

loop  back  until  all  the  data  is  processcKl 
Calculations 

-  P  =  [  ITQ-iT  ]-i 

-  a  X  =  P  TTQ-i  r 

update  the  xref(to)  =  3cc«f(to)  +  d  x(to  ) 

•4 

check  convergence  ,  jx(i)  <  [  Pii 
if  good,  end  with  xref (to) 

if  not,  begin  at  start  with  xref  (to)  euid  reset 


Pick  Aef  u  (tepoch  )  ,  initial  ^ess  for  state  vector 

set  Q  and  Uet  =  'Srefu 
read  all  data  and  store  in  2 

set  P-1 (-)  =  0  tepoeb  =  0 

2.  For  each  Bayes  iteration 

3.  For  each  least  squares  iteration 

Set  0  =  [I]  ;  TTQ-iT  =  0  ;  1TQ-»r  =  0 

For  each  observation  tiee 

move  ttef  (tepoch  )  to  JUef  (tl  ) 

Hamintf  and  rhs  do  this  to  xr«r  and 

calculate  predicted  data  using  xraf (ti )  =  spred 

calculate  H 

T=  H 

sum  £TTQ-iT 
sum  ZT^Q-lr 

loop  back  until  each  data  segment  is  processed 

P-i(  +  )  =  P-M-)  +  TTQ-it 

6x  =  P(  +  )  [  P-i  (-)(*(-)-’3ttef  )  +  TTQ-ir  ] 

Xref  ^to)  =  ]Eref(to)  +  i  JC 

determine  convergence  as  done  for  least  squares 
no  yes 


look  back  for  another  L.S. 
iteration 


P-i(-)  =_P-i(  +  ) 

IteB* (ti )  =  y(*,nxt) 

lueftt(tl  )  =  Xrmt  (tl  ) 


\  ‘  L.’V  .V 


.  L'^.  W^.“. 


APPENDIX  E 


BAYES  FILTER  PROGRAHS 
Descrip'blon 

The  purpose  of  this  program  is  to  utilize  the  truth  model 
data  and  estimate  the  launch  vehicle  parameters  of  the  vehicle. 
It  accomplishes  this  by  using  a  Bayes  Filter  algorithm.  The 
program  Is  identical  to  the  one  Capt.  Vallado  developed  In 
his  thesis  (reference  4)  with  the  addition  of  a  staging  de¬ 
tection  routine  (subroutine  Stage)  and  an  additional  estima¬ 
tion  routine  to  aid  in  determining  the  staging  time  as  well 
as  the  next  stage  exhaust  velocity  and  mass  ratio  (Va  and  M) . 

A  brief  description  of  the  subroutines  peculiar  to  this  pro¬ 
gram  are  as  follows: 

MMPY 

This  subroutine  multiplies  two  matrices  together  and  out¬ 
puts  the  product. 

MTRANS 

This  subroutine  calculates  the  transpose  of  a  matrix. 
MATPRT 

This  subroutine  prints  a  matrix. 

OBSER 

This  subroutine  calculates  the  observation  relationships. 
Its  main  fimct-ions  are  to  calculate  the  ^  matrix,  the  predic¬ 
ted  value,  the  H  matrix,  and  the  in-track  residual  for  the 
first  pass  of  nonlinear  least  squares  for  each  Bayes  segment. 
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STAGE 


This  subroutine  is  responsible  for  utilizing  the  in-track 
residual  computed  by  the  Obser  subroutine,  and  determining 
if  a  staging  event  has  taken  place.  It  then  passes  this  in- 
foimation  to  the  staging  estiaator  in  order  to  estiaate  the 
staging  time  and  next  stage  vehicle  parameters.  Once  the 
staging  estimator  has  converged,  the  new  values  for  the 
product  of  exhaust  velocity  and  mass  ratio  and  the  time  of 
the  staging  event  are  passed  back  to  the  main  program  in  or¬ 
der  to  restart  the  Bayes  Filter  routine  to  process  observa¬ 
tion  data  for  the  next  stage. 


PROGRAM  BAYES 

C  NONLINEAR  LEASTSQUARES  ALGORITHM 

C  THIS  PROGRAM  ACCOMPLISHES  A  NONLINEAR  LEAST  SQUARES  ALGORITHM 

C  FOR  THE  PROBLEM  OF  ESTIMATION  OF  LAUNCH  VEHICLE  PERFORMANCE 

C  PARAMETERS.  THE  PROGRAM  USES  OBSER  TO  CALCULATE  THE  Q  INVERSE, 

C  THE  APPROPRIATE  H  MATRIX,  AND  THE  OBSERVATION  MATRIX,  THE 

C  PROGRAM  ALSO  USES  DHAMING  TO  NUMERICALLY  INTEGRATE  THE  STATE, 

C  AND  RHS  TO  CALCULATE  THE  EON  AND  EOV. 

C  THE  COMMON  TERMS 

COMMON  /HAM/  T,Y<72,4) ,F(72,4) ,ERR(72) ,N,DT,MODE,TEPOCH,TSTAGE 
DOUBLE  PRECISION  T,Y,F,ERR,DT,TEPOCH,TSTAGE 
INTEGER  N,MODE,NXT 


C  THE  OTHER  TERMS 

DOUBLE  PRECISION  TIME0B<500) ,RH0(500) ,AZ(500) ,EL<500) , 

+  PHI(8,8),H<3,8),TMAT(3,8),Z(3),ZPRED(3),DX(8,1), 

-I-  Q1<3,3),RESID<3),T0B,U0RK<8),HTQ1<8,3),PINV0(8,8), 

+  HTQ1R<8,1),XREF<8,1),P(8,8),TMATT(8,3),SIGTRK, 

-t-  PINVN<8,8),XREFU<8,1),XMXREF<8,1),PNDX(8,1), 

+  PNDXPH<8,1),HTQ1T<8,8),PINVNC<8,8),PC(8,8),PINV01 

+  <8,8>,PHIC<8,8),PHIIN(B,8),PHIT(8,8),BETA(8,8), 

+  BETAT<8,8) ,PINV02<8,B> ,RINTRK(500) ,TIMTRK<500) , 

+  XSTAGE<3),PSTG(2,2) 


+ 

+ 


I NTEGER  I LA , ILB , I LC , ILD , ILE , ILF , MAX IT , NOB , TROP , I LNOB , 

NPTS, ILCC, ISTAGE, ICOUNT, ILG, ILH, ILI , ILJ, ILK , ILL , 
ILM,ILN,ILO,ILP,NUMPTS 


J 


C  OPEN  OUTPUT  AND  INPUT  FILES  FOR  FILTER  DATA,  IN  TRACK  RESIDUALS 

C  AND  INPUT  SENSOR  DATA 


OPEN ( UNIT« 18 , F I LE= ' F I LTDAT ' , ACCESS= ' SEQUENT I AL ' , STATUS^ ' NEW ' ) 

•  OPEN ( UNIT*19 , F ILE= ' PLOTDAT ' , ACCESS* ' SEQUENTIAL ' , STATUS* ' NEW ' )  _ 1 

0PEN(UNIT*14,FILE='TDATA',ACCESS*'SEQUENTIAL',STATUS*'0LD') 

REWIND(UNIT*14) 


C  READ  IN  INITIAL  DATA  AND  ALL  CONTROL  PARAMATERS 


PRINT*, 'INPUT  EPOCH  TIME' 

READ*,TEPOCH 

PRINT*, 'INPUT  INITIAL  STATE  VECTOR  GUESS,  XREF' 
READ*,XREFU<l,l),XREFU(2,l),XREFU(3,l),XREFU<4,l),XREFU(5,l), 
+  XREFU<6,1),XREFU(7,1),XREFU<8,1) 
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/-  .'*•  , 


>  -  •  .  r  .'V'* 


PRINT*, 'INPUT  THE  MAX  LS  ITERATIONS' 

READ*, MAX IT 

PRINT*, 'INPUT  THE  RANK  OF  P' 

READ«,TROP 

PRINT*, 'INPUT  THE  NUMBER  OF  BAYES  LOOP  ITERATIONS' 
REAP*,IBLOOP 


PRINT*, 'INPUT  *  DATA  POINTS  READ  EACH  LEASTSQUARES  RUN' 
READ«,ILNOB 

PRINT*, 'INPUT  BETA,  FOR  THE  FADING  MEMORY  ' 
READ*,BETA<1,1),BETA<2,2),BETA(3,3),BETA(4,4),BETA(5,S), 
BETA(6,6) ,BETA(7,7) ,BETA<8,8) 

PRINT  OUT  THE  INPUT 

FORMAT </,31X, 'NONLINEAR  BAYES  FILTER' ,/,/,2X, 

'INITIAL  STATE  VECTOR  :  ',/,2X,4E18.11,/,2X,4E18.11, 
/,2X, 'INITIAL  TIME  :  ',F8.A,'  *  OF  DATA  POINTS  J  ', 
I4,/,2X,'MAX  LS  ITERATIONS  t  ',18, 

'  ♦  OF  BAYES  CHUNKS  :  ',I4,/,2X, 

'MAX  BAYES  ITERATIONS  :  ',14,'  RANK  OF  P  t  ', 

Ill, /,2X, 'BETA  MATRIX  *  ',8F6.3) 

WRI TE < 18, 10 )  XREFU , TEPOCH ,MOB , MAXIT , ILNOB , IBLOOP , TROP , 

BETA<1,1),BETA(2,2),BETA(3,3),BETA(4,4),BETA(5,S), 
BETA<6,6) ,BETA<7,7) ,BETA(8,8) 

SET  LAST  ITERATION,  STAGING  EVENT  FLAG  AND  VARIOUS  COUNTERS 

NDATA=3 

TSTAGE=TEPOCH 

I8TAGE=0 

ID0NE=0 

CALL  MEQL(XREFU,8,1,XREF) 

DO  40  I6J=1,8 
DO  40  IBI=1,8 

PINV0<IBJ,IBI)=0.0D+00 

CONTINUE 


BEGIN  BAYES  FILTER  LARGE  LOOP 
DO  10000  IBG=1, IBLOOP 

BEGIN  ITERATION  LOOP  -  NONLINEAR  LEAST  SQUARES 

READ  IN  OBSERVATIONS  FOR  EACH  BAYES  SEGMENT  PROVIDING  IT  IS 
NOT  JUST  AFTER  A  STAGING  EVENT 

IF  (ISTAGE.EQ.l)  GOTO  35 
NUMPTS=ILNOB 


DO  30  XLB=1,ILN06 

»  READ(14,«,END=7000)  RH0<ILB),AZ(ILB),EL(ILB)>TIHE06(ILB) 

CONTINUE 


CONTINUE 

DT=TIME0B<2)-TIME0B<1) 


DO  9999  ILC=1,MAXIT 

REINITIALIZE  NUMERICAL  INTEGRATION  PARAMETERS 

T=TEPOCH 

M0DE=1 

N=72 

ICS  ARE  NEW  REFERENCE  TRAJ  GUESS 


DO  50  ILD=1,8 

Y(ILD,1)=XREF(ILD,1) 

CONTINUE 

PHI  INITIAL  CONDITIONS 

DO  60  ILE=9,72 
Y(ILE,l)*0.0D+00 
CONTINUE 

DO  70  ILF*9,72,9 
Y<ILF,l)=1.0D+00 
CONTINUE 


INITIALIZE  NAMING  AND  RESET  THE  TIME 
NXT=0 

CALL  NAMING <NXT) 

T=TEPOCH 

INITIALIZE  BUFFERS  FOR  MATRIX  PRODUCT  ACCUMULATION 

DO  80  ILG=lf8 

HTQ1R<ILG,1)=O.OD+O0 
DO  80  ILH=1,8 

HTQlT<ILG,ILH)=0.0D+00 

CONTINUE 

PRINT  FIRST  OR  LAST  PASS  RESIDUAL  HEADERS  WHEN  NECESSARY 

F0RMAT</,2X, 'FIRST  PASS  RESIDUALS:  ',/) 

FORMAT </,2X, 'LAST  PASS  RESIDUALS:  ',/) 

IFCILC.EQ.l)  WRITE(18,90) 

IFdDONE.EQ.l)  WRITE(18,95) 


OBSERVATION  PROCESSING  LOOP 


NPTS=0 

IF(ILC.EQ.l)  SIGTRK=0.0D+00 
DO  1000  ILI=1,NUMPTS 
EXTRACT  EACH  OBSERVATION 


T0B=T1ME0B(ILI) 

Z(1)=RH0<ILI) 

Z(2)=AZ(ILI) 

Z(3)=EL(ILI) 

NUMERICALLY  INTEGRATE  STATE  AND  PHI  TO  OBS  TIME 
THE  NUMBER  OF  STEPS  HERE  IS  EQUAL  TO  1  SINCE  WE 
HAVE  DT  SET  EXACTELY  THE  SAME  AS  THE  TRUTH  DATA  WE  READ 

NSTP=1 

DO  100  ILK*1,NSTP 
CALL  HAMINGCNXT) 

CONTINUE 


ILCC=ILC 

NPTS=NPTS+1 


OBTAIN  MATRICES  FOR  THIS  OBSERVATION 

CALL  OBSER ( TOB , Q 1 , ZPRED , H  f NXT , Z , RINTRK , NPTS » I LCC , 
TIMTRKrSIGTRK) 

MATRIX  STUFF  -  THIS  OBSERVATION 

DO  120  ILL=1,NDATA 

RESID< ILL)=Z< ILL)-ZPRED< ILL ) 

CONTINUE 

IFdLI.LT.S)  GOTO  200 
IF<(ID0NE,EQ,1).AND»<IL1.LT,5))  GOTO  200 
IF((ID0NE.EQ.1).AND.(ILI.GE.5))  GOTO  240 
GOTO  250 
CONTINUE 

WRITE(18,*)'TIME,  RES  =' ,TOB, <RESID(ILM) ,ILM=1 ,NDATA) 

IF  THIS  IS  LAST  PASS,  WE'VE  ALREADY  CONVERGED, 

SO  SKIP  MATRIX  CALCULATIONS 


IF(IDONE.EQ.l)  GOTO  9000 
CONTINUE 

EXTRACT  PHI  MATRIX  IN  NORMAL  FORM 


DO  2&0  ILN=1,8 


DO  270  IL0=1,8 

PHI<ILN,ILO)=Y(B»ILO+ILN,NXT) 

270  CONTINUE 

260  CONTINUE 

C  FORM  MATRIX  *»»»**  TMAT=H*PHI 

CALL  MMPY(H,3,8,PHI,8,TMAT) 

C  FORM  MATRIX  HTQ1=T  TRANSPOSE  «  Q  INVERSE 

CALL  MTRANS<TMAT,3,8,TMATT) 

CALL  NNPY(TMATT,8,3,Q1,3,HTQ1) 

C  FORM  MATRIX  ****%*  HTQ1T=T  TRANSPOSE  Q  INVERSE  T 

C  SUM  THROUGH  THE  OBSERVATIONS 

DO  290  1LP=1,8 
DO  290  ILQ=1,8 

DO  280  ILR=1»NDATA 

HTQ1T<ILP, ILQ) =HTQ1T ( ILP, ILQ)+HTQ1 ( ILP, ILR) 
+  *TMAT(ILR,ILQ) 

280  CONTINUE 

290  CONTINUE 

C  FORM  MATRIX  »»#»»*  HTQ1R=T  TRANSPOSE  Q  INVERSE  R 

C  SUM  THROUGH  THE  OBSERVATIONS 

DO  ISO  ILS=1>8 

DO  150  ILT=1,NDATA 

HTQlR<ILS,l)=HTaiR(ILS,l)  +HTQ1(ILS,ILT)» 

+  RESID<ILT) 

150  CONTINUE 

9000  CONTINUE 

1000  CONTINUE 

C  LOOK  BACK  FOR  OBSERVATION  LOOP  OF  LEAST  SQUARES 

DO  420  IBE=1,8 
DO  420  IBF=1,8 

PINVN<IBE,IBF)=PINV0<IBE,IBF)+HTQ1T(IBE,IBF) 

420  CONTINUE 

CALL  HEQL(PINVN,8,8rPINVNC) 

C  HAVE  ME  JUST  FINISHED  PRINTING  LAST  PASS  RESIDUALS  ? 

IF(IDONE.EQ.l)  GOTO  5000 

C  NOW  ME  CHECK  FOR  IN  OR  OUT  OF  TRACK  CONDITION 

C  IF  ME  ARE  NOT  IN  THE  FIRST  BAYES  FILTER  SEGMENT 

C  OR  HAVE  JUST  PAST  A  STAGING  EVENT 
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IF((IB6.EQ.l).0R.<IST/>i6E.EQ.l))  THEN 
ISTAGE=0 
GOTO  6000 
END  IF 

CHECK  IF  THIS  IS  THE  FIRST  ITERATION  OF  THE  BAYES  SEGMENT 
BEFORE  STARTING  THE  STAGING  ROUTINE 

IF<ILC.EQ.l)  CALL  STA6E(RINTRK, ILNOB,TIHTRK,SIGTRK, 

ISTA6E , XSTAGE , XREFU , TSTAGE  t 
PSTG) 

IF  THE  VEHICLE  HAS  STAGED  THE  STAGING  ROUTINE  IS  PERFORMED 
IF  <ISTAGE.EQ.l)  THEN 
STAGING  ROUTINE 

FIRST  IDENTIFY  THE  POINT  IN  THE  DATA  WHERE  STAGING  TOOK  PLACE 
IC0UNT=0 

DO  500  ILG=1,ILN0B 

IF  <XSTAGE(2)*LT.TIME0B(ILG))  GOTO  505 
IC0UNT=IC0UNT+1 
CONTINUE 

CONTINUE 

NOW  THAT  THE  POINT  IN  THE  SENSOR  DATA  DIRECTLY  BEFORE  STAGING 
HAS  BEEN  IDENTIFIED,  THE  STATE  AND  COVARIANCE  MUST  BE  MOVED 
TO  THE  STAGING  TIME 

REINITIALIZE  INTEGRATION  PARAMETERS 

T=TEPOCH 

M0DE=1 

N*72 


SET  THE  STATE  INITIAL  CONDITIONS  TO  THE  LAST  GOOD  VALUES 
OF  THE  STATE  AVAILABLE 

DO  510  ILH=1,8 

Y<ILH,1)=XREFU<ILH,1) 

CONTINUE 

SET  INITIAL  CONDITIONS  FOR  THE  PHI  MATRIX 

DO  515  ILI=9,72 
Y(ILI,l)=0,0D+00 
CONTINUE 


DO  520  ILJ=9,72,9 


I 


Y(ILJ,1)=1.0D+00 

CONTINUE 

INITIALIZE  NAMING  AND  RESET  THE  TIME 
NXT=0 

CALL  NAMING  (NXT) 

T=TEPOCH 

PROPAGATE  STATE  AND  PHI  TO  THE  STAGE  TIME 

DO  525  ILK=l,ICOUNT 
CALL  HAMING  <NXT) 

CONTINUE 

TEPOCH=T 

EXTRACT  THE  PHI  MATRIX  IN  NORMAL  FORM 

DO  535  ILM=i,8 
DO  534  ILN=1,8 

PHI < ILM,ILN)=Y<8*ILN+ILM,NXT) 

CONTINUE 

CONTINUE 

CALCULATE  UPDATED  P  MATRIX  AT  NEW  START  TIME 

CALL  MTRANS  (PHIf8,8,PHIT> 

CALL  MMPY  <PHI,8,8,P,8,PINV01) 

CALL  MMPY  (PINV01»8,8,PHIT,8,P) 

NEW  GUESS  FOR  NEXT  STAGE  WILL  BE  COMPRISED  OF  POSITIONAL  AND 
VELOCTTv  A~  TIME  INCREMENT  JUST  BEFORE  STAGING  EVENT, 

VE  WILL  BE  GIVEN  VALUE  OF  LAST  STAGE  VE,  AND  M  WILL  BE  GIVEN 
VALUE  OF  ESTIMATED  VECM  DIVIDED  BY  VE  GUESS.  WILL  ALSO  UPDATE 
THE  TSTAGE  TIME. 

DO  530  ILL=1,8 

Y<ILL,1)=Y<ILL,NXT) 

XREF(ILL,1)=Y(ILL,NXT) 

CONTINUE 

XREF (8,1) =XSTAGE ( 1 ) /XREF (7,1) 

CALL  MEQL  (XREF,8,1,XREFU) 

TSTAGE=XSTAGE(2) 

MUST  NOW  ALTER  THE  COVARIANCE  MATRIX  TO  TELL  THE  FILTER  THAT 
IT  NO  LONGER  KNOWS  THE  VALUES  OF  VE  AND  M  AS  WELL  AS  BEFORE 
STAGING  EVENT 

P(8,8)=PSTG<1,1)/(XREFU(7,1)*XREFU(7,1))+ 

(XSTAGE(1)»XSTAGE(1)/(XREFU(7,1)» 

XREFU(7,1 )*XREFU(7,1 )»XREFU(7, 1 ))* 


86 


P<7,7)) 


P(7,7)=2.0Ii+OOi|tP(7,7) 

PRINT  HEADER  FOR  THE  NEXT  STAGE  ESTIMATION 

FORMAT  </,/,26X, 'BEGIN  ESTIMATION  OF  THE  NEXT  STAGE 
/,/,26X, 'STAGING  OCCURED  AT  I  ',F8.4,2X, 
'SECONDS',/,/) 

WRITE  <18,550)  TSTAGE»:806.8136D+00 

WRITE  (18,*)  '  AT  THE  START  OF  THE  NEXT  STAGE  THE' 

WRITE  <18,950)  P 

FORMAT  <2X, 'INITIAL  STATE  VECTOR  IS:',/,/,2X, 
4E18.11,/,2X,4E18.11) 

WRITE  <18,555)  XREFU 

FIRST  MOVE  THE  REMAINING  DATA  POINTS  TO  THE  FRONT  OF  THE 
BAYES  SEGMENT  ARRAY 

DO  5A0  IL0=1,ILN0B-IC0UNT 
RHO<ILO)=RHO<ICOUNT+ILO) 

AZ<ILO)=AZ<ICOUNT+ILO) 

EL<ILO)=EL<ICOUNT+ILO) 

TIMEOB< ILO)=TIMEOB< ICOUNT+ILO) 

CONTINUE 


CHANGE  THE  NUMBER  OF  POINTS  TO  BE  PROCESSED  AFTER  A  STAGING 
EVENT  BY  4  TIMES 


NUMPTS=4i|!lLN0B 

NOW  READ  IN  ENOUGH  OBSERVATION  DATA  POINTS  TO  FILL  THE 
RADAR  OBSERVATION  ARRAY  FOR  THE  NEXT  BAYES  RUN 

DO  570  ILP=ILN0B-IC0UNT+1,NUMPTS 

READ  <14,»,END=7000)  RHO<ILP) ,AZ<ILP) ,EL<ILP) , 
TIMEOB<ILP) 

CONTINUE 


UPDATE  THE  COVARIANCE  MATRIX  TO  PASS  BACK  TO  BAYES  FILTER 


CALL  MEQL<P,8,8,PC) 

CALL  LINVIF  <PC,8,B,PINV0,0,W0RK,IER) 


GOTO  10000 
END  IF 


CONTINUE 


DATA  IS  PROCESSED.... IMPROVE  ESTIMATE 
INVERT  MATRIX  H  TRANSPOSE  Q  INVERSE  H  TO  FIND 
COVARIANCE  P 

CALL  LINV1F<PINVNC,TR0P,B,P,0,U0RK,IER) 

CALL  MEQL<P,8»8,PC) 

FORM  MATRIX  tttttt  DX=P»T  TRANSPOSE  Q  INVERSE  R 
DO  600  IBC=1,8 

XMXREF  < I BC , 1 ) =XREFU ( I BC , 1 ) -XREF ( IBC , 1 ) 

CONTINUE 

CALL  MMP Y  <  P I NVO , 8 , 8 , XMXREF , 1 , PNDX ) 

DO  640  IBD=1,8 

PNDXPH  < IBD , 1 ) =PNDX ( IBD , 1 ) +HTQ1R ( IBD , 1) 

CONTINUE 

CALL  MNPY<P,8,8,PNDXPH,1,DX) 

ADD  IN  STATE  CORRECTIONS 
DO  700  ILV=1,8 

XREF(ILV,1)=XREF(ILV,1)+DX(ILV,1) 

CONTINUE 

PRINT  ITERATION,  AND  CURRENT  GUESS 

FORMAT </,2X, 'ITERATION  ' ,13,/,/, 2X, 'STATE  CORRECTIONS' 
,/,2X,4E18.11,/,2X,4E18.11) 

URITE<18,720)  ILC,DX 

FORMAT </,2X, 'CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR 
'AT  epoch:  ',/,2X,4E18.11,/,2X,4E18.11,/) 

URITE< 18,740)  XREF 

SUCCESS  ????????? 

CHECK  CONVERGENCE 

IFAIL=0 

DO  800  ILU=i,8 

IF<BABS<DX< ILU,1 ) ) ,6T.0. 1*DSQRT<DABS<P< ILU, ILU) ) ) ) 
IFAIL*1 
CONTINUE 

IF  <IFAIL  .EQ.  0)  ID0NE=1 
CONTINUE 

LOOP  BACK  FOR  NEXT  ITERATION  OF  LEAST  SQUARES 

FAILURE  FOR  THE  LEAST  SQUARES  M !!!!!!!!!!! ! 

FORMAT <2X, 'MAXIMUM  ITERATION  LIMIT  EXCEEDED  WITHOUT 
CONVERGENCE.') 


PRINT  900 
URITE(18,900) 

STOP 

SUCCESS  FOR  THE  LEAST  SQUARES  MM!!!!!!!!!! 

CONTINUE 

FORMAT </t2X,' C0NUER6ENCE  ACHIEVED ,',/,2X, 

'IN  NOMINIA  6AUSSIAH  TRAJECTORUH  REFERENTIA' 
2X,'DECLARIUM  EST  ESTIMATIA' ,/) 

PRINT  940 
WRITE (18, 940) 

PRINT  COVARIANCE  MATRIX 

F0RMAT</,2X, 'COVARIANCE  MATRIX  AT  EPOCH  IS*.  ',/, 
8<1X,5E14.7,/,1X,3E14.7,/,/)  ) 
URITE(18,950)  P 

LOAD  NEW  STATE  VECTOR,  AND  RESET  PHI 

DO  960  IBR=1,8 

Y(IBR,1)=Y<IBR,NXT) 

XREF(IBR,1)=Y(IBR,NXT) 

CONTINUE 

CALL  MEQL<XREF,8,1,XREFU) 

EXTRACT  PHI  MATRIX  IN  NORMAL  FORM 


I.  .  J 


1.  .  i 


DO  985  IBV*1,8 
DO  985  IBH=:1,8 

PHI(IBV,IBU)=Y<8»IBW+IBV,NXT) 

CONTINUE 

CALCULATE  UPDATED  P  MATRIX  AT  NEW  START  TIME 

CALL  MEQL<PHI,8,8,PHIC) 

CALL  LINV1F<PHIC,8,8,PHIIN,0,U0RK,IER) 
CALL  MTRANS(PHIIN,8,8,PHIT) 

CALL  MMPY(PHIT,8,8,PINVN,8,PINV01) 

CALL  MMPY<PINV01,8,8,PHIIN,8,PINVN) 

CALL  MMPY<BETA,8,8,PINVN,8,PINV0) 

CALL  MTRANS(BETA,8,8,BETAT) 

CALL  MEQL(PINV0,8,8,PINV02) 

CALL  MMPY < PINV02 ,8,8, BETAT , 8, PINVO ) 


I _ j 


L _ ! 


TEPOCH  =T 
ID0NE=0 

URITE<18,<t)  'BEGIN  NEXT  BAYES  LOOP' 


10000  CONTINUE 


»  < 


I 


LOOP  BACK  FOR  BAYES  FILTER  LOOP 


WRITE<18.«)  'UE  DID  IT,  SUCCESS  WITH  BAYES' 

GOTO  8000 

CONTINUE 

PRINT*, 'RAN  OUT  OF  RADAR  OBSERVATIONS' 
URITE(18,»)'  RAN  OUT  OF  RADAR  OBSERVATIONS' 

CONTINUE 


ENDFILE<UNIT*14) 

ENDFILE(UNIT«18) 

ENDFILE(UNIT»19) 

END 

SUBROUTINE  HEQL < HAT7 , HAT7R , HAT7C , HATS ) 

DOUBLE  PRECISION  HAT7<HAT7R,HAT7C) 

INTEGER  MAT7R,HAT7C 

DOUBLE  PRECISION  HAT8(HAT7R,HAT7C) 

INTEGER  INF, IMG 

DO  3000  IMF=1,HAT7R 
DO  3000  IH6=1,MAT7C 

MAT8<IMF,IMG)=HAT7(IHF,IHG) 

CONTINUE 

RETURN 

END 

SUBROUTINE  LSTIME<LST,T,TO,LON) 

DOUBLE  PRECISION  LST,T,TO,LON 
DOUBLE  PRECISION  THTG0,TU0PI,6ST 
T0=0,0D+0O 

TU0Pl36.28318S30718D-f00 

THT60«98 . 8548 IDf 00* ( 3 . 1 4159265359Di00/ 1 80 . 00D400 ) 
GST=THTG0+1 .0027379093D+00*< (T*l3.44A86457D+00/ 
1440,OD+00)-TO) 

6ST»DH0D(6ST,TU0PI) 

LST=GST+LON 

LST»DMOD<LST,TWOPI) 

RETURN 

END 


SUBROUT INERRDST(RS,LRT,LST,T,TO,ANS,INO) 

DOUBLE  PRECISION  RS(0:3) ,LAT,LST,T,TO 
CHARACTER  ANS 

DOUBLE  PRECISION  STA,STE,STI,ST0HGA,STAR6P,STU(0:3) ,STH,STN, 

STNUO 

INTEGER  I NO 

LAND  BASED  SENSOR 

IF  (ANS.EO.'LM  THc;N 
IF  <INO.EQ.O)  THEN 

PRINT*, 'INPUT  THE  ELEVATION  OF  THE  SITE' 

READ«,RS(0) 

INO^IO 
END  IF 

RS  < 1 ) =RS  <  0 ) *DCOS ( L AT ) *DCOS  <  LST ) 

RS<2)=RS<0)*DC0S<LAT)*DSIN(LST) 

RS<3)=RS(0)«DSIN(LAT) 

RETURN 

END  IF 

SPACE  BASED  SENSOR 

IF  (ANS.EQ.'S')  THEN 
IF  (INO.EO.O)  THEN 

PRINT*, 'INPUT  THE  TRACKING  SAT  ORBIT  DATA,  A,  E,  I,  OMEGA,  ARGP 
READ* ,  ST  A ,  STE ,  ST  I ,  STOMGA ,  ST  ARGP 
END  IF 

STN=DSQRT< 1/<STA*STA*STA) ) 

STM=STN*(T-TO) 

CALL  RANDV ( STA , STE , STI , STOMGA , STARGP , STNUO , STM ,RS , STV ) 

CALL  MAG(RS) 

IF  (INO.EO.O)  THEN 

F0RMAT<3X, 'A' ,6X, 'E' ,6X, 'I' ,5X, 'OMEGA' ,3X, 'ARGP' ,4X, 'M' ) 
F0RMAT<6(1X,F6.3)) 

WRITE(17,*) 

WRITE<17,*)  'THE  TRACKING  SATELLITE  DATA  IS' 

URITE(17,64) 

WRI TE  < 17 , 66 )  STA , STE , STI , STOMGA , STARGP , STM 
IN0=10 
END  IF 

END  IF 


RETURN 


SUBROUT I NE  RANHU  <  A , E , I NC , OMEGA , AR6P  r  NUO , H , R , U ) 

DOUBLE  PRECISION  A,E, INC,0MEGA,AR6P,NU0,H,R(0:3) ,U<0:3) 

DOUBLE  PRECISION  RAD,P,EL,EO,MO 

RAD=3 .141 592&5359D+00/ 1 80 . OOD+00 

MO*M*RAD 

INC=INC»RAD 

ARGP=ARGP*RAD 

0ME6A=0MEGA»RA0 

P=A»(1-E*E) 

NEWTON  RHAPSON  ITERATION 

EL=MO 

EO=EL 

EL=EO- <  EO-E*DS IN ( EO ) -MO ) / < 1 . 0D+00-E*DCOS  <  EO ) ) 

IF  (DABS<EL-E0).GT.1.0D-12)  THEN 

EL=EO- <  EO-E»DSIN  <  EO )-M0) / ( 1 .0D+00-E»DC0S ( EO ) ) 

GOTO  8 
END  IF 

FIND  THE  VALUE  OF  THE  TRUE  ANOMALY 

NU0=DATAN2 ( <  DSQRT  < 1 . 0D+00-E*E ) ) »DSIN( EL ) / (1 . OD+OO-E* 
DCOS  <  EL ) ) , ( E-DCOS  <  EL ) ) / ( E»DCOS ( EL ) - 1 . OD+00 ) ) 

POSITION  AND  VELOCITY  VECTORS 

R  ( 1 )  =Pi|tDCOS  ( NUO )  /  <  1 .  OD+OO+EUDCOS  ( NUO ) ) 
R<2)=R(1)*DTAN(NU0) 

R<3)=0.0D+00 

V<1)=-DSIN<NU0)/DSQRT(P) 

V<2)=(E+DC0S<NU0))/DSQRT<P) 

V(  3)  =0,004-00 

RETURN 

END 

SUBROUTINE  MAG<RX) 

DOUBLE  PRECISION  RX(0;3) 

RX<0)=DSQRT<RX<1)*RX<1)-4RX<2)*RX(2)-4RX<3)*RX(3)) 

RETURN 

END 

SUBROUTINE  CROSS(RIN,VIN,VX) 


DOUBLE  PRECISION  RIN<0‘.3) ,VIN(0:3) ,VX(0;3) 


VX<l)=RIN(2)«VIN(3)-yiN<2)«RIN(3) 
VX(2)=-RIN(l)»VIN<3)+yiN<l)*RIN(3) 
VX(3)=RIN(l)*VIN(2)-yiN<l)»RIN(2) 
CALL  MAG(VX) 

RETURN 

END 


SUBROUTINE  HAHIN6(NXT) 

COMMON  /HAM/T , Y  <  72 , 4 ) , F  <  72 , 4 ) , ERREST  <  72 ) , N , DT , NODE , TEPOCH , 
TSTAGE 


DOUBLE  PRECISION  T, Y,F, ERREST, DT, TEPOCH, TSTAGE 
INTEGER  N,MODE,NXT 

INTEGER  IDA,IDB,IDC,IDD,IDE,IDF,IDG,IDH,IDI,IDJ,IDK,IDL,IDM,IDN 

DOUBLE  PRECISION  TOL,HH,XO 

THE  VARIABLES  ARE  USED  AS  FOLLOWS 
T 

Y(72,4) 

F<72,4) 

ERREST 
N 

DT 

MODE 


T0L=1,0D-12 
IF  (NXT)  190,10,200 

SWITCH  ON  STARTING  ALGORITHM  OR  NORMAL  PROROGATION 
THIS  IS  HAMINGS  STARTING  ALGORITHM. , ,A  PREDICTOR-CORRECTOR 
NEEDS  4  VALUES  OF  THE  STATE  VECTOR  ,  AND  YOU  ONLY  HAVE  1,  THE 
I.C.  HAMIN6  USES  PRICARD  ITERATION  (SLOW  AND  PAINFULL)  TO  GET 
THE  OTHER  THREE • 

IF  IT  FAILS,  NXT=  0  ON  EXIT,  OTHERWISE,  NXT=1,  AND  IT'S  OK. 


INDEPENDENT  VARIABLE  (TIME) 

STATE  VECTOR  IN  4  COPIES 
EQUATIONS  OF  MOTION,  4  COPIES 

CALL  RHS(NXT)  UPDATES  ENTRY  IN  F 
ESTIMATE  OF  TRUNCATION  ERROR 
NUMBER  OF  EQUATIONS  BEING  INTEGRATED 
TIME  STEP 

0  FOR  EOM.  1  FOR  EOM  AND  EOV 


XO=T 

HH=DT/2.0D+00 
CALL  RHS(l) 

DO  40  IDA=2,4 
T=T+HH 

DO  20  IDB=1,N 

Y(1DB,IDA)=Y(IDB, IDA-1 )+HH»F(IDB, IDA-1) 
CONTINUE 
CALL  RHS(IDA) 

T=TtHH 

DO  30  IDC»1,N 


Y(IDC,IDA)=Y<IDC,IDA-1)+DT»F(IDC,IDA) 

CONTINUE 
CALL  RHS(IIIA) 

CONTINUE 

IDD=-10 

IDE=1 

DO  120  IDF=1,N 

HH=Y  < I DF , 1 ) +DT» ( 9 . 0D+00*F (I BF , 1 ) + 19 . 0D+00»F ( I DF , 2 ) - 
5 . 0D+00»F  < IDF , 3 ) +F  < IDF , 4 ) ) /2A .OD+00 
IF  (DABS<HH-Y(IDF,2)).LT.T0L)  GOTO  70 
IDE=0 

Y(IDF,2)=HH 

HH=Y(IDF,l)+DT»(F(IDF,l)+4.0D+00*F(IDF,2)+F<IDF,3))/3,0D+00 

IF  <DABS(HH-Y(IDF,3)).LT.T0L)  GOTO  90 

IDE»0 

Y(IDF,3)=HH 

HH=Y  < IDF , 1 ) +DT*  <  3 . 0D+00<F ( IDF , 1 ) +9 , 0D+00*F ( IDF , 2 )  + 

9 . 0D+00»F  < I DF , 3 ) +3 . 0D+00*F  < IDF , 4  > ) /8 . OD+00 
IF  <DABS<HH-Y<IDF,4)).LT.T0L>  GOTO  110 
IDE=0 

Y(IDF,4)=HH 

CONTINUE 

T=XO 

DO  130  ID6=2,4 
T»T+DT 

CALL  RHS(IDG) 

CONTINUE 

IF  (IDE)  140,140,150 
IDD-IDDFl 

IF  (IDO)  50,280,280 

T=XO 

IDE=1 

IDD=1 

DO  160  IDH=1,N 
ERREST(IDH)=0.0 
CONTINUE 
NXT=1 
GOTO  280 
ID0=2 

NXT=IABS(NXT) 

THIS  IS  HAMINGS  NORMAL  PROPAGATION  LOOP 
T*TtDT 

IDL«H0D(NXT,4)-fl 
GOTO  (210, 230), IDE 

PERMUTE  THE  INDEX  NXT  MODULO  4 

GOTO  ( 270 , 270 , 270 , 220 ) , NXT 
I0E»2 

IDI=M0D(IDL,4)+1 

IDJ*M0D(1DI,4)+1 


IDK=M0D(IDJ,4)+1 


C  THIS  IS  THE  PREDICTOR  PART 

DO  240  IDH=1,N 

F (I DM , I DI ) =Y ( I DM , I DL) +4 . 0D+00*DT» ( 2 ♦ 0D+00»F ( I DM , IDK ) - 
■I-  F  ( IDM ,  ID  J )  ■i■2  .ODfOO»F  ( IDM,  IDI ) )  /3 . 0D400 

Y(IDM,IDL)=F<IDM,IDI)-0. 9256 1 9835D+00*E  RREST ( I DM ) 

240  CONTINUE 

C  NOW  THE  CORRECTOR  -  FIX  UP  THE  EXTRAPOLATED  STATE 

C  BASED  ON  THE  BETTER  UALUE  OF  THE  EQUATIONS  OF  MOTION 

CALL  RHS(IDL) 

DO  250  IDN=1,N 

Y ( I DN , IDL ) = <  9 , 0D+00»Y  <IDN,IDK)-Y(IDN,IDI)+3. 0D+00*DT* 

+  <F<IDN,IDL)+2.0D+00*F<IDN,IDK)-F(IDN,IDJ)))/8.0D+00 

ERREST<IDN)=F<IDN,IDI)-Y<IDN,IDL) 

Y  < I DN , I DL ) * Y  < I DN , I DL ) +0 . 074380 1 653D+00*ERREST ( I DN ) 

250  CONTINUE 

GOTO  <260,270),IDD 
260  CALL  RHS(IDL) 

270  NXT=IDL 

280  RETURN 

END 

SUBROUTINE  RHS<NXT) 

COMMON  /HAM/T ,Y<72,4),F<72,4),ERR<72),N,DT, MODE , TEPOCH , TST AGE 
DOUBLE  PRECISION  T, Y,F, ERR, DT, TEPOCH, TSTAGE 
INTEGER  N,MODE,NXT 

INTEGER  IRA , IRB , IRC , IRD, IRG, IRH, IRI , IRJ, IRK 

DOUBLE  PRECISION  R32,V32,UEL,VAT,WE,UEH,MASS,ACC,R52,AM(8,8) , 
+  MASSO,MDOT,VE 

C  THIS  DATA  STATEMENT  HARDWIRES  THE  PARTS  OF  THE 

C  A  MATRIX  WHICH  ARE  NEVER  CHANGED  ...ONLY  THE  MIDDLE 

C  3  ROWS  CHANGE  EACH  TIME 

DO  10  IRAai,8 
DO  10  IRB-1,3 

AM<IRB,IRA)=0.0D+00 
10  CONTINUE 

DO  20  IRC=1,8 
DO  20  IRD=7,8 

AM<IRD,IRC)=0.0D+00 
20  CONTINUE 

AM(l,4)=1.0D+00 
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AM<2,5)=1.0D+00 

AM(3,6)=1.0Df00 

THE  BASIC  FUNCTION  OF  RHS  IS  TO  CALCULATE  THE  EQUATIONS 
OF  MOTION  (THE  F  ENTRIES)  FROM  THE  GIVEN  CURRENT  STATE 
(STORED  IN  Y)  AND  THE  TIME  T 

EVALUATION  OF  THE  EQUATIONS  OF  MOTION 

REFERENCE  BATES  MEULLER  S  WHITE,  PG  10,  N  BODY  PROBLEM 
WITH  ORIGIN  IN  SUN. 

POSITION  DOT  =  VELOCITY  VECTOR 

F(1,N)(T)=Y(4,NXT) 

F(2,NXT)=Y(5,NXT) 

F(3,NXT)=Y(6,NXT) 

VELOCITY  DOT  =  GRAVITY  ACCELERATION 

R32=(Y(1,NXT)»Y(1,NXT)+Y(2,NXT)»Y(2,NXT)+ 

Y ( 3 , NXT ) * Y ( 3 , NXT ) ) . 5B+00 
VEL=(Y(4,NXT)»Y(4,NXT)+Y(5,NXT)»Y(5,NXT)+ 

Y(A,NXT)»Y(4,NXT)  )«.5D+00 
V32=VEL*»3.0D+00 

SET  THE  CONSTANTS  WHICH  WILL  BE  USED  IN  THE  A  MATRIX 

XMU=1.0D+00 

VE=Y(7,NXT) 

MASS=Y(8,NXT) 

VVE=VEL«VE 

VEM=VE*MASS 

ACC=VE*MASS/( 1 .0D+OO-MASS*(T-TSTAGE) ) 

F ( 4 , NXT ) =-XMU«Y ( 1 , NXT ) /R32+ACC»Y ( 4 , NXT ) / VEL 
F ( 5 , NXT ) =-XMU*Y ( 2 , NXT ) /R32+ACC»Y ( 5 , NXT ) / VEL 
F ( 6 , NXT ) =-XMU»Y ( 3 , NXT ) /R32+ACC*Y ( 6 , NXT ) /VEL 
F(7,NXT)=0.0D+00 
F(8,NXT)=0,0D+00 

END  OF  EQUATIONS  OF  MOTION 
IS  THIS  ALL  ? 

IF  (MODE.EQ.O)  RETURN 

IT  ISNT  ALL  ...  CALCULATE  THE  EQUATIONS  OF  VARIATION 
FIRST,  CALCULATE  A  MATRIX  ....  ONLY  LOWER  3X3  ISNT  HARDWIRED 

R52=R32** ( 5 . OD+00/3 , OD+00 ) 


DIAGONAL  TERMS  IN  A  MATRIX 


AM( 4 , 1 ) =-XHU/R32+3 . 0n+00*X«U»y ( 1 , NXT ) *Y (1 , NXT ) /R52 
AM<  5 , 2 ) =-XMU/R32+3 . 0D+00*XHU»Y ( 2 , NXT ) »Y ( 2 , NXT ) /R52 
AM(  6 , 3)  =-XMU/R32+3 . 0D+00*tXMU)|iY  ( 3,NXT )  »Y  ( 3 ,  NXT )  /R52 

OFF  DIABONAL  TERMS  IN  A  MATRIX  USE  SYMMETRY  TO  AVOID 
AS  MUCH  CALCULATION  AS  POSSIBLE. . .THIS  POINT  IS  DEEP 
WITHIN  LOTS  OF  LOOPS! 1 1 ! 

AM ( 4 , 2 ) =3 . 0D+00*XMU*Y  < 1 , NXT ) »Y ( 2 , NXT ) /R52 
AM(5,1)=AM(4,2) 

AM<  4 , 3 ) =3 . 0D+00*XMU*Y  < 1 , NXT ) »Y<  3 , NXT ) /R52 
AM(6,1)»AM(4,3) 

AM ( 5 , 3 ) =3 . 0D+00*XMU*Y  <  2 , NXT ) »Y ( 3 , NXT ) /R52 
AM(6,2)-AM<5,3) 

NOW  SOME  STUFF  FOR  THE  OTHER  TERMS 

AM<  4 , 4 ) =- Y ( 4 , NXT ) »Y ( 4 , NXT ) *ACC/V32+ACC/VEL 
AM  ( 5 , 5 )  =- Y  ( 5 ,  NXT )  *  Y  <  5 ,  NXT )  »ACC/V32+ ACC/ VEL 
AM<6,6)=-Y(A,NXT)»Y(6,NXT) *ACC/V32+ACC/ VEL 

AM(4,5)=-Y<4,NXT)*Y(5,NXT)»ACC/V32 

AM(5,4)=AM<4,5) 

AM<4,6)=-Y<4,NXT)*Y<&,NXT)»ACC/V32 

AH(6f4)»AH<4,6) 

AM<5,6)=-Y<5,NXT)*Y<A,NXT)»ACC/V32 

AM(6,5)=AM<5»6) 

AM<4,7)=Y(4,NXT)*ACC/VVE 
AM<  5 , 7 ) *Y ( 5 , NXT ) »ACC/VVE 
AM  <  6 , 7 )  =  Y  ( 6 ,  NXT )  *ACC/ WE 

VAT=ACC*ACC*T/VEM+ACC/MASS 

AM  <  4 , 8 ) = Y ( 4 , NXT ) *VAT/ VEL 
AM  <  5 , 8 ) = Y ( 5 , NXT ) *V AT/VEL 
AM<  6 , 8 ) =Y ( 6 , NXT ) #VAT/VEL 

THE  A  MATRIX  IS  NOW  CALCULATED 

NOW,  CALCULATE  PHI  DOT=A*PHI  AND  PUT  INTO  LAST 
64  SLOTS  OF  THE  F  MATRIX 

DO  800  1RG=1,8 
DO  800  IRH:=lf8 
IRI=8«IRH-I-IR6 
F(IRI,NXT)=0.0D+00 
DO  700  IRJ=I,8 
IRK=8«IRH+IRJ 

F(IRI,NXT)=F(IRI,NXT)+AM(IRG,IRJ)»Y<IRK,NXT) 

CONTINUE 


800 


CONTINUE 


C  PHI  DOT=A»PHI  IS  NOW  DONE 

RETURN 

END 

SUBROUTINE  RAZEL(R,U,RHO,AZ,EL,TO,T,RS,TRM) 

DOUBLE  PRECISION  R(0:3) ,U<0:3) ,RH0»lSZrEL,T0,T,RS(0:3) ,TRM(3,3) 

DOUBLE  PRECISION  LAT,L0N,LST,ZVEC<0:3) ,SVEC<0:3) ,EVEC<0:3) ,RAD, 
+  RH0VE(0:3) ,KUEC<0:3) ,RH0VEC<0:3) ,RE(0:3) ,RSE(0:3) 

INTEGER  IN6»INH,INIfINJ,INK,INL,INH,INN,INNL 

CHARACTER  ANS 

IF  (IN6.EQ.0)  THEN 

PRINT*, 'ENTER  SENSOR  TYPE,  LAND  OR  SPACE,  IN  QUOTES' 

READ*, ANS 
ING>10 

RAD=3 . 1 4 1 59265359D+00/ 180 . OD+00 
KVEC<l)=0.0D+00 
KUEC(2)=0,0D+00 
KVEC(3)=1.0D+00 
END  IF 

IF  <<ANS.EQ.'L').AND,<INH.EQ.O))  THEN 

PRINT*, 'INPUT  THE  LAT  AND  LON  OF  SITE  IN  DEG,  EAST+,WEST-' 
READ*, LAT, LON 
LAT=LAT*RAD 
LON=LON*RAD 
INH=10 
END  IF 

CALL  LSTIHE<LST,T,TO,LON) 

CALLRADST<RS,LAT,LST,T,TO,ANS,INO) 

DO  100  INI=1,3 

RHOVE  < INI ) =R ( INI ) -RS  < INI ) 

100  CONTINUE 

CALL  MAG (RHOVE) 

RHO=RH0VE(0) 

C  SET  UP  LOCAL  COORDINATE  SYSTEM 

DO  no  INJsl,3 

ZVEC(INJ)=RS<INJ)/RS<0) 
no  CONTINUE 

CALL  CROSS <KVEC,ZVEC,EVEC) 

DO  112  INM=1,3 
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EVEC(INM)=EVEC<INM)/EVEC(0) 

CONTINUE 

CALL  CROSS (EVEC,ZVEC,SVEC) 

DO  114  INN=1,3 

SVEC ( I NN ) =SVEC ( I NN ) /SVEC ( 0 ) 

CONTINUE 

SET  UP  THE  TRANSFORMATION  FOR  UK  =  TRM*SEZ 

DO  120  INL=1,3 

TRM<INL,l)=SyEC<INL) 

TRM(INL,2)=EVEC(INL) 

TRM(INL,3)=ZVEC(INL) 

CONTINUE 
DO  121  INNL=1,3 
RE(INNL)=R(1NNL) 

RSE<INNL)=RS(INNL) 

CONTINUE 

CONVERT  TO  SEZ  FOR  CALCULATIONS 
DO  130  INK=1,3 

RHO VEC (INK) =RHOVE  < 1 ) «TRH ( 1 , 1 NK ) +RHOVE ( 2 ) »TRM ( 2 , 1 NK ) 
+RH0VE<3)<tTRM(3,INK) 

R(INK)=RE(1)*TRM<1,INK)+RE(2)*TRM(2,INK)+ 

RE<3)*TRM<3,INK) 

RS<INK)=RSE(1)*TRM<1,INK)+RSE(2)*TRM(2,INK) 

+RSE<3)*TRM<3»INK) 

CONTINUE 

IF  <RHOVEC<1).EQ.O.OD+O0)  THEN 

IF  (RH0VEC(2) .GT.O.OD+00)  AZ=90.0D+00»RAD 
IF  <RHOVEC<2),LT.O.OD+O0)  AZ*270.0D+00»RAD 
IF  <RH0VEC<2),EQ.0,0D+00)  THEN 
AZ=0.0D+00 

IF  <RH0VEC(3).GT.0.0D+00)  EL=90,0D+00*RAD 
IF  <RH0VEC(3).LT,0.0D+00)  EL=-90.0D+00*RAD 
END  IF 
END  IF 

IF  ( (RHOVEC(l) .NE,O,0D+OO).AND.(RHOVEC(2).NE.O,OD+0O))  THEN 
AZ=DAT AN  <  RHOVEC ( 2 ) /RHOVEC ( 1 ) ) 

EL=DAT AN  <  RHOVEC  <  3 ) /DSQRT  <  RHOVEC ( 1 ) tRHOVEC ( 1 ) +RHOVEC ( 2 ) » 
RH0VEC<2))) 

IF  (RH0VEC(l).LT,0,0D+00)  AZ=AZ+180,OD+00»RAD 
IF  <(RH0VEC<l).GT.0.0D+00).AND.(RH0VEC<2).LT.0,0D+00))  AZ 
AZ+360.0D+00*RAD 

END  IF 

RETURN 

END 

SUBROUTINE  MMPY < MAT 1 , MAT 1 R , MAT 1 C , MAT 2 , MAT 2C , M AT3 ) 


DOUBLE  PRECISION  MAT1<MAT1R,MAT1C) ,MAT2(MAT1C,MAT2C) , 
HAT3<MAT1R,MAT2C) 

INTEGER  IMA,IMB,IMC,MATlR,MATlC,HftT2C 

DO  4000  IHMlfHATlR 
DO  4000  IHB=l,Hrtr2C 

M0T3(IMA,IHB)=0.0D+00 
DO  4000  IMC=1,MAT1C 

HAT3<IHA,IHB)=MAT3<IHA,IMB)+ 

HAT  1  <  IHA ,  I HC )  »HAT2  ( I HC ,  I HB ) 

CONTINUE 

RETURN 

END 

SUBROUTINE  HTRANS ( HAT4 , HAT4R , HAT4C , MATS ) 

DOUBLE  PRECISION  HAT4(MAT4R,MAT4C) ,MAT5(MAT4C,MAT4R) 

INTEGER  MAT4R,MAT4C 

INTEGER  IHD,IHE 

DO  4020  IMD=1,MAT4R 
DO  4020  IHE=1,MAT4C 

MAT5<IME,IMD)=MAT4<IMD,IHE) 

CONTINUE 

RETURN 

END 

SUBROUT I NE  M ATPRT  <  MAT6 , HAT6R , HAT6C ) 

DOUBLE  PRECISION  MAT6<MAT6R,MAT6C) 

INTEGER  MAT6R,MAT6C 

INTEGER  IHH^INI 

F0RMAT<10<1X,E12,6)) 

DO  4030  IMH=1,MAT6R 

WRITE<*,4040)  <MAT6(IMH,IMI),IMI=1,MAT6C) 

CONTINUE 

RETURN 

END 

SUBROUTINE  OBSER ( TOB , 0 1 , ZPRED , H , NXT , Z , R I NTRK , NPTS , 
ILCC,TIMTRK,SIBTRK) 

DOUBLE  PRECISION  T0B,ai<3,3) ,ZPRED(3) ,H(3,8) ,Z(3) ,RINTRK<500) 


TIMTRK<500),SIGTRK 


INTEGER  NXT,ILCC,NPTS 

COMMON  /HAM/  T, Y<72,4) ,F(72,4) ,ERR(72) ,N,DT,MODE,TEPOCH 
DOUBLE  PRECISION  T, Y,F,ERR,DT,TEPOCH 
INTEGER  N,HODE 

DOUBLE  PRECISION  T0,R<0:3) ,U(0J3) ,RH0,AZ,EL,RS(0:3) ,SIGEL, 
0HM1,AZDN0M,ELDN0M,ELBTM»HIT(3,3),TRM(3,3),SIGRH0, 
SIGAZ,R0<3),R0BSER<3),RTRK<3),R0B(3),SIG1,SIG2,SIG3, 
VSEZ<0:3),SIGT0T 

INTEGER  IOA,IOC,IOD,IOE,IOF,IOT,IOU,IOU,IOU,IOX,IOY,IOZ»IOZZ 

RANGE  -  AZIMUTH  -  ELEVATION  DATA 

Q  INVERSE  MATRIX 

DO  10  I0C=1,3 
DO  10  I0D=1,3 

Ql<I0C,I0D)»0.0D-t-00 

CONTINUE 

SPECIFY  SIGMA  RHO,  AZ,  AND  EL 

SIGRHO*.00001D+00 

SIGAZ=,001D+00 

SIGEL=.001D+00 

ai<l,l)=SIGRHO*SIGRHO 

Q1<2,2)=SIGAZ«SIGAZ 

Q1<3,3)=SI6EL»SIGEL 

DO  17  I0E=1,3 

Ql<I0E,I0E)=l,0D+00/ai(I0E,I0E) 

CONTINUE 
T0=0,0D+00 
DO  11  I0A=1,3 

R<IOA)=Y(IOA,NXT) 

V<I0A)=Y<I0A+3,NXT) 

CONTINUE 

CALL  RAZEL(R,V,RHO,AZ,EL,TO,T,RS,TRN) 

COMPUTE  THE  INTRACK  RESIDUALS  FOR  FIRST  PASS  ONLY 
IF  (ILCC.EQ.l)  THEN 

COMPUTE  THE  SIGMA  FOR  INTRACK  RESIDUALS 
FIRST  UE  NEED  VELOCITY  IN  SEZ  FRAME 


DO  12  I0F=1,3 

VSEZ<I0F)=TRM<UI0F)«V(1)+TRM(2,I0F)*V<2)+TRH(3,I0F)* 

y(3) 

CONTINUE 


CALL  HA6<ySEZ) 

COMPUTE  THE  COEFFICIENTS  FOR  INTRACK  SIGMA 

SIGl-ySEZ( 1)«DC0S<Z(2) )«DC0S(Z(3) )iySEZ(2)»DSIN<Z(2) )» 
DC0S<Z<3))+VSEZ(3)*DSIN<Z(3)) 


SIG2=USEZ<2)*Z<1)*DC0S(Z(2))»DC0S(Z(3))-VSEZ<1)»Z(1)» 

DSIN(Z(2))«DC0S(Z<3)) 


SIG3=ySEZ(3)«Z<l)«DC0S(Z<3))-VSEZ(l)«Z(i)»DC0S(Z(2})» 

DSIN<Z(3))-ySEZ(2)«Z(l)tDSIN(Z(2))»DSIN(Z(3)) 

COMPUTE  SIGMA  INTRACK 


SIGTOT=DSQRT  <  SIGKSIGl/Ql  <  1 , 1 )  +SIG2»SIG2/Q1  <  2 , 2 )  + 
SIG3«SIG3/Ql(3,3))/ySEZ(0) 
S1GT0T=SIGT0T»1.0D-01 

NOW  DETERMINE  UORST  SIGMA  INTRACK  FOR  OBSERVATIONS 
IF <  SIGTOT . GT . SIGTRK )  SI6TRK=SIGT0T 


CONVERT  RHO  OBSERVED  TO  SEZ  FRAME  COMPONENTS 

R0<1)=Z<1)*DC0S<Z(2))*DC0S(Z(3)) 

R0<2)=Z(1)»DSIN<Z<2))«DC0S<Z(3)) 

R0<3)=Z<1)»DSIN<Z(3)) 

R  OF  OBSERVATION  IN  SEZ  FRAME  EQUALS  RHO  IN  SEZ  FRAME 
PLUS  R  OF  RADAR  SITE  IN  SEZ  FRAME 


DO  13  I0X=1,3 

ROB<IOX)=RO<IOX)+RS(IOX) 

CONTINUE 

MUST  NOW  CONVERT  R  OBSERVATION  TO  THE  UK  FRAME 
DO  14  I0Y=U3 

ROBSER  < lOY ) =TRM (lOY , 1 ) »ROB ( 1 ) +TRM  < lOY , 2 ) *ROB  <  2 )  + 
TRM<I0Y,3)*R0B<3) 

CONTINUE 

RTRK  =  R  OF  OBSERVATION  -  R  OF  NAMING  IN  UK  FRAME 
DO  15  I0Z=lf3 

RTRK ( lOZ ) *ROBSER  < lOZ) -Y ( lOZ , NXT ) 


CONTINUE 


INTRACK  RESIDUAL  IS  THEN  COMPUTED  AS  RINTRK=RTRK  DOT 
VELOCITY  VECTOR  DIVIDED  BY  MAGNITUDE  OF  VELOCITY  VECTOR 

RINTRK<NPTS)=0.0D+00 
CALL  MAG<V) 

DO  16  IOZZ=l,3 

RINTRK  <  NPTS ) =R I NTRK ( NPTS ) +RTRK ( I OZZ ) »V  < lOZZ ) / V ( 0 ) 
TIMTRK(NPTS)=TOB 
CONTINUE 

END  IF 

THIS  CALCULATES  THE  G  MATRIX 

ZPRED<l)=RHO 

ZPRED<2)=AZ 

ZPRED(3)=EL 

THE  H  MATRIX 

NOTE  THAT  R  AND  RS  ARE  IN  SEZ 

0HM1=<R(1)-RS<1))*<R<1)-RS<1))+<R(2)-RS(2))*(R(2)-RS(2)) 

+<R(3)-RS<3))*<R<3)-RS<3)) 

H ( 1 , 1 )  =  ( 1 . OD+OO/DSQRT  <  OHMl ) > t ( R( 1) -RS ( 1 ) ) 
H<l,2)=(1.0D+00/DSQRT<0HMl))»(R(2)-RS(2)) 
H(l,3)=(1.0D+00/DSQRT<0HMl))*(R<3)-RS(3)) 

H<l,4)=0,0Dt0O 

H(l,5)=0.0D+00 

H(l,6)=0,0D+00 

H(l,7)=0,0D+0O 

Hn,8)=0.0D+00 

AZDNOM=  1 .  0D+00+  <  ( R  ( 2 )  -RS  ( 2 ) )  /  <  R  ( 1 )  -RS  ( 1 ) ) )  * 
((R(2)-RS(2))/<R<1)-RS<1))) 

H(2,l)  =  (-(R<2)-RS<2))/(<R(l)-RS(l))i|i(R(l)-RS(l))))/AZDNOM 

H ( 2 , 2 ) = ( 1 . OD+00/ ( R ( 1 ) -RS ( 1 ) ) ) / AZDNOM 

H(2,3)=0.0D+00 

H<2,4)=0.0D+0O 

H(2,5)=0,0D+00 

H(2,6)=0.0D'^00 

H(2,7)=0.0D+00 

H(2»8)=0.0D+00 

ELBTM=(R<1)-RS<1))»<R<1)-RS(1))+<R(2)-RS(2))*(R<2)-RS(2)) 
ELDNOM=l ,0D+00+( <R(3)-RS(3) )*<R(3)-RS(3) ) )/ELBTM 

H(3,1)=(<-(R<1)-RS<1))*(R(3)-RS{3)))/DSCIRT(ELBTM*ELBTM*ELBTM)) 


/ELDNOH 

H(3,2)=((-(R<2)-RS(2))»<R(3)-RS(3)))/DSQRT(ELBTM*ELBTM»ELBTH)) 

/ELDNOH 

H ( 3 , 3 ) = ( 1 . OD+OO/DSQRT ( ELBTH  >  > /ELDNOH 

H(3,4)=0.0D+00 

H(3,5)=0.0D+00 

H(3,6)=0.0D-f00 

H(3,7)=0.0Dt00 

H(3,8)=0.0D-f00 

CONVERT  TO  UK  FRHHE 

DO  2010  I0T=1,3 

HIT(1,I0T)=H<1,I0T) 

HIT(2,I0T)=H<2,I0T) 

HIT<3,I0T)*H<3,I0T) 

CONTINUE 
DO  2020  I0U»1»3 
DO  2020  10V=1,3 

H(IOU,IOV)=O.OD-I-O0 
DO  2020  I0U=1»3 

H<IOU,IOV)=HIT(IOU,IOM)*TRH(IOV,10W)+H(10U,IOV) 

CONTINUE 

RETURN 

END 

SUBROUT I NE  STAGE <  RINTRK , ILNOB , T IHTRK , SI GTRK , I STAGE , XST AGE , 
XREFU,TSTAGE,PST6) 

DOUBLE  PRECISION  RINTRK<500),TIHTRK<500)»SIGTRK,XREFU(B,1), 
TST AGE , XSTAGE ( 2 ) , PSTG  <  2 , 2 ) 

INTEGER  ILNOB, ISTAGE 

DOUBLE  PRECISION  TC0HH,TIMRES,CIINV(1,1), 

ZSTG , T I HOBS , ZSTGPRD , ANOT , DELX (2,1),TTQIT(2,2), 
TTQIR(2,1),THTSTG(1,2),TDIFF,TTQI(2,1),RESSTG(100), 
THSTGT  <  2 , 1 ) ,PSTGI <  2 ,2 ) , WORK  <  2 ) , TNTOLD 

INTEGER  ITA,ITC,ITD,ITE,ITF,ITG,ITH,ITI,ITJ,ITK,ICNT,RCNT, 
DONE , ITL , ITH, NITSfSDONE, ITN 

FIRST  WE  SEND  THE  SIGHA  IN  TRACK  VALUE  TO  THE  OUTPUT  FILE 
FORHAT  (/,2X, 'SIGHA  IN-TRACK  =  ',E20.13,/) 

URITE< 18,200)  SIGTRK 

MUST  NOW  DETERMINE  A  STAGING  EVENT  HAS  TAKEN  PLACE  AND  HILL 
KEEP  TRACK  OF  THE  OBSERVATION  THE  STAGING  EVENT  SINGLED  OUT 

D0NE=0 


I _ 1 


i  ( 


>  A.  ••  •  •  . 
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ISTAGE=0 

RCNT=0 

ICNT=0 

DO  21  ITR  =  l,ILNOB 
RCNT^RCNT^l 

IF  (ABS(RINTRK<1TA)).GT.(3.0D+00»S1GTRK))  THEN 
ICNT=ICNT+1 
GOTO  20 
END  IF 
ICNT=0 

IF  <ICNT.EQ.3)  THEN 
I STAGE* 1 
GOTO  22 
END  IF 
CONTINUE 

CONTINUE 

RCNT  =RCNT-3 

NOU  UE  BEGIN  THE  ESTIMATION  OF  THE  PARAMETERS  OF  THE  NEXT 
STAGE  ONCE  A  STAGING  EVENT  HAS  BEEN  DETECTED  BY  USING  THE 
REMAINING  RESIDUALS 

IF  <ISTAGE.EQ»1)  THEN 

FILL  PLOT  OF  THE  STAGING  EVENT  RESIDUALS 

FORMAT  <2<2X,E20.13)) 

DO  23  ITL*1,ILN0B 

WRITE  (19,201)  RINTRK(ITL),TIMTRK(ITL) 

TOMTINUE 


PRINT*, 'A  STAGING  EVENT  HAS  BEEN  DETECTED' 

WILL  NOU  PRINT  OUT  THE  LAST  VALUE  FOR  THE  MAIN  STATE  VECTOR 


FORMAT  </,2X,'LAST  GOOD  VALUES  FOR  THE  MAIN  STATE  VECTOR', 
/,/,4(2X,E18.11),/,4(2X,E18.11),/) 

WRITE  (18,230)  XREFU 

FIRST  UE  MUST  INPUT  OUR  INITIAL  GUESS  FOR  THE  STAGING 
STATE  vector;  ve*m  and  TSTAGE 


PRINT*, 'INPUT  INITIAL  GUESS  FOR  THE  STAGING  STATE  VECTOR' 
READ* , XST AGE ( 1 ) , XSTAGE ( 2 ) 

PRINT*, 'INPUT  THE  MAX  LEAST  SQUARES  ITERATIONS  TO  RUN' 
READ*, NITS 


PRINT  OUT  THE  HEADER  FOR  THE  STAGING  ESTIMATOR 


FORMAT  (/,27X, 'NONLINEAR  LS  STAGING  ESTIMATOR' ,/,/,2X, 
'INITIAL  GUESS  IS  ;',/,/,2X, 

'VE*M  =  ',E18.11,2X,'TSTAGE  =  ', 

E18.il) 

WRITE  (18,202)  XSTA6E< 1) ,XSTAGE(2) 

MUST  THEN  INITIALIZE  T  TRANSPOSE  »  Q  INVERSE  »  T  AND 
T  TRANSPOSE  »  Q  INVERSE  »  RESIDUAL  SUMATIONS  AND  SPECIFY 
THE  VALUE  OF  0  INVERSE  WHERE  Q  INVERSE  IS  A  1  BY  1  MATRIX 
CONSISTING  OF  THE  RECIPROCAL  OF  THE  SQUARE  OF  THE  IN  TRACK 
SIGMA  AS  USED  PREVIOUSLY  AS  SIGTRK 


QINV  < 1 , 1 )  =  1 . OD+00/ <  SIGTRKtSIGTRK ) 

WILL  NOW  PRINT  OUT  THE  VALUE  OF  Q  INVERSE 

FORMAT  (/,2X,'Q  INVERSE,  A  1  X  1  MATRIX,  IS  :',/,/,2X, 
E18.il) 

WRITE  (18,231)  QINVd,!) 

DO  25  ITE=1,2 

TTQIR(ITE,l)*0.0D+00 
DO  25  ITL=1,2 

TTQIT(ITE,ITL)=0.0D+00 

CONTINUE 


WILL  NOW  START  THE  NONLINEAR  LEAST  SQUARES  ITERATION  LOOP 
DO  100  ITD*1,NITS 

PRINT  FIRST  OR  LAST  PASS  RESIDUAL  HEADERS  WHEN  NECESSARY 

FORMAT  (/,2X, 'FIRST  PASS  RESIDUALS  t  ',/) 

FORMAT  (/,2X,'LAST  PASS  RESIDUALS  5',/) 

IF  (ITD.EQ.l)  WRITE  (18,203) 

IF  (DONE.EQ.l)  WRITE  (18,204) 

NOW  IT  WILL  PROCESS  THE  OBSERVATIONS 

DO  99  ITF=RCNT,ILNOB 

READ  IN  THE  OBSERVATIONS 

ZSTG=RINTRK(ITF) 

TIMOBS=TIMTRK(ITF) 

NOW  COMPUTE  THE  PREDICTED  VALUE  OF  ZSTG  (ZSTGPRD) 

T IMRES=XST AGE ( 2 ) -TSTAGE 
TNTOLD= 1 . 0D+00-XREFU( 8 , 1 ) »T IMRES 
TDI FF=T I M0BS-XSTA6E ( 2 ) 

ANOT= ( XREFU (7,1) »XREFU (8,1) /TNTOLD ) -XST AGE ( 1 ) 


ZSTGPRD=-AN0T»TDIFF»TDIFF/2.0D+00 


NOW  COMPUTE  RESIDUALS  FOR  EACH  OBSERVATION 

RESSTG  < ITF ) =ZSTG-ZST6PRD 

C  PRINT  OUT  FIRST  FIVE  RESIDUAL  VALUES  FOR  FIRST  AND  LAST  PASS 

IF  <ITF.LT.<RCNT+5))  GOTO  30 
IF  < (DONE. EQ.l). AND. (ITF. LT.(RCNT+5)))  GOTO  30 
IF  ((DONE. EQ.l). AND. (ITF. 6E.(RCNTF5)))  GOTO  35 
GOTO  40 

30  CONTINUE 

220  FORMAT  (/,2X, 'RESIDUAL  =  E18.il) 

WRITE  (18,220)  RESSTGdTF) 

35  CONTINUE 

IF  (DONE. EQ.l)  GOTO  55 

40  CONTINUE 

C  CALCULATE  T  MATRIX  FOR  EACH  OBSERVATION 

TCOMM=XREFU (7,1) 4XREFU (8,1) *XREFU ( 8 , 1 ) 4TDIFF* 

+  TDIFF/(TNTOLD»TNTOLD) 

TMTSTG (1,1) *TDIFF»TDIFF/2 . OD+00 

TMTSTG (1,2) =-TC0MM/2 . 0D+00+ ANOTfTDIFF 

C  NOW  THAT  THE  T  MATRIX  HAS  BEEN  CALCULATED  WE  CAN  SUM 

C  TTQIT  AND  TTQIR.  FIRST  WE  WILL  COMPUTE  T  TRANSPOSE  » 

C  Q  INVERSE 


CALL  MTRANS(TMTST6,1,2,TMSTGT) 

CALL  MMPY ( TMSTGT , 2 , 1 , QINV , 1 , TTQI ) 

C  NOW  WE  FORM  THE  SUMATION  T  TRANSPOSE  *  Q  INVERSE  »  T 


DO  45  IT6=1,2 
DO  45  ITH=1,2 

TTQIT(ITG,ITH)=TTQIT(IT6,ITH)+TTQI(IT6,1)* 

+  TMTSTG(1,ITH) 

45  CONTINUE 

C  NOW  WE  FORM  THE  SUMATION  T  TRANSPOSE  *  Q  INVERSE  *  RESIDUAL 


DO  50  ITI=1,2 

TTOIR( ITI , 1 )=TTQIR( ITI , 1 ) +TTQI ( ITI , 1 )*RESSTG( ITF ) 
50  CONTINUE 


[•] 


CONTINUE 


CONTINUE 

DID  WE  JUST  PRINT  THE  LAST  PASS  RESIDUALS  ? 

IF  (DONE.EQ.l)  GOTO  110 

ONCE  ALL  OBSERVATIONS  HAVE  BEEN  PROCESSED 

MUST  NOW  FIND  THE  COVARIENCE  MATRIX  P  BY  FINDING  THE  INVERSE 

OF  THE  SUMMATION  OF  T  TRANSPOSE  «  Q  INVERSE  *  T 

CALL  MEQL<TTQIT,2,2,PST6I) 

FORMAT  </,2X,'P  INVERSE  MATRIX  IS  2(2X,E18. 11 ) ,/, 

2(2X,E18.11)) 

URITE  (18,236)  PSTGl 

CALL  LINV1F(PSTGI,2,2,PST6,0,U0RK,IER) 

FORMAT  </,2X,'P  MATRIX  IS  t ' ,/,/»2(2X,E18. 11 ) ,/, 

2(2X, E18.il)) 

URITE  (18,235)  PSTG 

NOU  COMPUTE  DX  =  P  »  T  TRANSPOSE  *Q  INVERSE  t  RESIDUAL 


CALL  MMPY(PSTG,2,2,TTQIR,1,DELX) 

NOW  UPDATE  THE  GUESS 
DO  60  ITJ=1,2 

XSTAGE(ITJ)=XSTAGE(ITJ)+DELX(ITJ,1) 

CONTINUE 


PRINT  ITERATION  NUMBER  AND  CURRENT  STATE  VECTOR 

FORMAT  (/,2X,' ITERATION  ' ,13,/,/, 2X, 'STATE  CORRECTIONS' 
/,2(2X,E18,11)) 

URITE  (18,205)  ITD,DELX(1,1),DELX(2,1) 

FORMAT  (/,2X, 'CURRENT  STAGING  STATE  VECTOR  ',/,2X, 

'VE*M  =  ',E18.11,2X,'TSTAGE  =  ',E18.11,/) 

WRITE  (18,206)XSTAGE 

NOU  UE  CAN  CHECK  FOR  CONVERGENCE 

SD0NE>0 
DO  65  ITK=1,2 

IF  (DABS(DELX(ITK,1)).6T,0.01»DSQRT(PSTG(ITK,ITK))) 
SDONEsl 
CONTINUE 


IF  (SDONE.EQ.O)  DONE-l 


REINITIALIZE  T  TRANSPOSE  »  Q  INVERSE  «  T  AND  T  TRANSPOSE 
»  Q  INVERSE  »  RESIDUAL  SUMHATIONS  BEFORE  NEXT  ITERATION 

DO  70  ITH=1,2 

TTQIR(ITH,l)=0.0D+00 
DO  70  ITN=l,2 

TTQIT(ITN,ITN)=0.0D+00 

CONTINUE 

MILL  NOW  UPDATE  THE  OBSERVATION  COUNTER  (RCNT)  TO  INCLUED 
POINTS  FROM  THE  ESTIMATED  STAGING  EVENT  TIME  TO  THE  END 
OF  THE  AVAILABLE  DATA  (ILNOB) 

RCNT=0 

DO  75  ITN=1, ILNOB 

IF  (XSTAGE<2).LT.TIMTRK<ITN))  GOTO  80 
RCNT=RCNT+1 
CONTINUE 


CONTINUE 


CONTINUE 

FAIURE  FOR  LEAST  SQUARES 

FORMAT  </,2X,'  MAX  ITERATION  LIMIT  HAS  BEEN  EXCEEDED 
'UITHOUT  CONVERGENCE') 

WRITE  <18,207) 

PRINT  207 
GOTO  150 


CONTINUE 

FORMAT  </,2X, 'CONVERGENCE  HAS  BEEN  ACHEIVED' ,/,2X, 
'COVARIENCE  MATRIX  I  '/,/,2(2X,E18.11) , 
/,2<2X,E18.11)) 

WRITE  (18,208)PSTG 

PRINT*, 'CONVERGENCE  HAS  BEEN  ACHEIVED' 

END  IF 

CONTINUE 

RETURN 

END 


APPENDIX  F 


COMPUTER  ODTPOTS 

Once  -the  Bayes  Filter  estlaatlon  routine  was  functioning 
as  it  was  designed  to,  test  cases  involving  both  space  based 
sensor  data  and  land  based  sensor  data  were  processed.  The 
following  two  test  runs  are  an  indication  as  to  how  well  the 
the  algorithm  was  able  to  detect  the  staging  event  and  its 
subsequent  estimation  of  launch  vehicle  parameters  for 
stages  one  and  two.  The  first  case  involved  a  space  based 
sensor  with  the  following  inputs. 

Vehicle  Type:  Titan  34  D 

Time  of  Flight:  800.0  Seconds 

Epoch  Time:  .0020  TDs 

Launch  Site:  53.7  Degrees  North 

158.2  Degrees  East 

Elevation:  1.0  DO 

Sensor  type:  Space  based 

Semi -major  Axis 
Eccentricity 
Inclination 

Longitude  Of  Ascending  Node 
Argument  of  Perl apsis 

Sensor  type:  Land  Based 

52 . 6  Degrees  North 
174.1  Degrees  East 

Noisy  Data:  NO 

As  the  output  data  is  lengthy,  shown  here  is  only  a  portion 


2.5  DOs 
.25 

45.0  Degrees 
10.0  Degrees 
10.0  Degrees 


of  the  total  output.  It  consists  of  the  first  few  segaents 
of  data,  then  the  staging  estimator  output,  and  finally  the 
first  few  segments  after  staging. 


in 


Space  Based  Sensor 


NONLINEAR  BAYES  FILTER 


INITIAL  STATE  VECTOR  t 

-0 . 13260000000E+00-0 . 57700000000E+00  0 . 80590000000E+00-0 . 1 0230000000E-02 

-0.44490000000E-02  0.62640000000E-02  0.37380000000E+00  0.34A60000000E+01 

INITIAL  TIME  J  0.002000  *  OF  DATA  POINTS  J  0 

MAX  LS  ITERATIONS  t  20  *  OF  BAYES  CHUNKS  t  50 

MAX  BAYES  ITERATIONS  t  20  RANK  OF  P  t  8 

BETA  MATRIX  =  1.000  1.000  1.000  1.000  1.000  1.000  1,000  1.000 

FIRST  PASS  residuals: 

TIME,  RES  =  2.4957785237078558E-03  1 .2471533923696931E-05 

-4.1&0&240044511633E-05  -1 .2652892461550991E-07 

TIME,  RES  =  2.9915570474157117E-03  1 .2473467&57536&52E-05 

-4.1610263&75051495E-05  -1 .2434843579822719E-07 

TIME,  RES  =  3. 487335571 1235A75E-03  1 ,247533767451 1255E-05 

-4.1614616825447204E-05  -1 .2214112704578284E-07 

TIME,  RES  =  3.9831140948314234E-03  1 .2477139197109022E-05 

-4.1619320691244077E-05  -1 . 199056679224 1530E-07 

ITERATION  1 

STATE  CORRECTIONS 

-0.11309339093E-04  0.30464525995E-04  0,28282641496E-04  0.40945949387E-06 
-0.13957263612E-06  0.12810035276E-04  0.76595344581E-04-0.54924155120E-03 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH: 

-0 ,13261 130934E+00-0 . 57696953547E+00  0 . 80592828264E+00-0 . 10225905405E-02 
-0.44491395726E-02  0.62768100353E-02  0.37387659534E+00  0.34654507584E+01 

TIME,  RES  =  2,4957785237078558E-03  -3.9192687983913288E-10 

-8.2518381017138154E-11  -1 .4480680543549340E-10 

TIME,  RES  =  2.9915570474157117E-03  -3.8782438371853800E-10 

-9.i681717773184346E-ll  -1 .4276252402467549E-10 

TIME,  RES  =  3.4873355711235675E-03  -3,8462921736481803E-10 

-1.0159606489423822E-10  -1 ,4138007431441224E-10 

TIME,  RES  =  3.9831140948314234E-03  -3,8229130971956238E-10 

-1.1 231 049423798822E-10  - 1 , 406294525274631 7E- 1 0 

ITERATION  2 

STATE  CORRECTIONS 

0,20971850799E-09  0.33441979242E-09-0.34102483818E-09-0,38685863784E-08 
0.30343688610E-08  0.23657136994E-07-0.59597386603E-04  0.52813333676E-03 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH: 

-0.13261130913E+00-0.57696953514E+00  0.80592828230E+00-0,10225944091E-02 
-0.44491365383E-02  0.62768336924E-02  0.37381699796E+00  0.34659788918E+01 
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LAST  PASS  RESIDUALS 


TIME,  RES  =  2.495778523707B558E-03  9.5A4571357145723&E-14 

-2.2204460492503131E-15  A.7890137955828322E-14 

TIME,  RES  =  2.9915570474157117E-03  3.8402(S14421784165E-13 

-4.71844785465&9153E-15  2.59570143157361&OE-13 

TIME,  RES  =  3. 487335571 1235<S75E-03  8.6525231424161575E-13 

-8 . 8262730457699945E- 15  5 . 797307078836411 2E-13 

TIME,  RES  =  3.9831140948314234E-03  1 .5406009801210985E-12 

- 1 . 4876988529977098E- 1 4  1 . 029676344 1 8860 1 4E- 1 2 

CONVERGENCE  ACHIEVED, 

IN  NOMINIA  6AUSSIAM  TRAJECTORUM  REFERENTIA 

DECLARIUM  EST  ESTIMATIA 


COVARIANCE  MATRIX  AT  EPOCH  IS! 

0 .3903003E-07-0 . 4647810E-07  0 . 6463529E-07-0 . 3220947E-06  0 . 6177572E-06 
-0 . 860471 lE-06  0 . 2759423E-02-0 . 2541794E-01 

-0.4647810E-07  0.8326810E-07-0.5708883E-07  0.3861013E-06-0. 1028979E-05 
0.8447621E-06-0.3286934E-02  0.3027752E-01 


0 .6463529E-07-0 . 5708883E-07  0 . 1214895E-06-0 .5307781E-06  0 . 8547547E-06 
-0 . 1613920E-05  0 . 4669196E-02-0 .429871 lE-01 


-0 , 3220947E-06  0 . 386101 3E-06-0 . 5307781 E-06  0 , 5565299E-05-0 , 9360608E-05 
0.1294712E-04-0.4411564E-01  0.4071111E+00 


0 ,6177572E-06-0 . 1028979E-05  0 ,8547547E-06-0 .9360608E-05  0 . 2902532E-04 
-0.2977864E-04  0.9511079E-01-0.8728340E+00 


-0.8604711E-06  0.8447621E-06-0.1613920E-05  0. 1294712E-04-0.2977864E-04 
0 .49991 16E-04-0 . 1348810E+00  0 , 1237383E+01 


0.2759423E-02-0.3286934E-02  0.4669196E-02-0,4411564E-01  0.9511079E-01 
-0.1348810E+00  0.4107946E+03-0.3776804E+04 


-0 . 2541794E-01  0 . 3027752E-01-0 . 429871 lE-01  0,407111 lE+00-0 . 8728340E+00 
0.1237383E+01-0.3776804E+04  0.3472634E+05 


BEGIN  NEXT  BAYES  LOOP 
FIRST  PASS  residuals: 

TIME,  RES  =  2.7284704709100647E-02  2.6514423989709712E-10 

-2.4041879598257765E-13  1 ,7619125602941210E-10 

TIME,  RES  =  2.7780483232808503E-02  2,7602270469273549E-10 

-4.2021941482062175E-14  1 .8338669471873459E-10 

TIME,  RES  =  2.8276261756516359E-02  2.8713670330304808E-10 

1.8635093468333253E-13  1 .9073448376261 126E-10 

TIME,  RES  =  2.8772040280224215E-02  2.984B823412947922E-10 
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4.404809850200308&E-13  1 .9823623298442783E-10 


SIGMA  IN-TRACK  =  0.187A563478352E-03 


ITERATION  1 
STATE  CORRECTIONS 

-0. 60443228642E-10-0 .2&295044084E-09  0 . 368008&4849E-09-0 , 509371 88823E-08 
-0.22163236041E-07  0. 30398 170500E-07  0. 88831 160205E-08  0.36375652277E-05 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH! 

-0.132&4929669E+00-0.57713481264E+00  0.80616992864E+00-0.20694915263E-02 
-0. 900401 00775E-02  0.13751501020E-01  0.37381700A84E+00  0.34&59825294E+01 


LAST  PASS  residuals: 

TIME,  RES  =  2.7284704709100A47E-02  3.3306690738754A9AE-1A 

-6.1062266354383610E-1A  2.38697950294408A6E-15 

TIME,  RES  =  2,7780483232808503E-02  3,219&467714129540E-15 

-2 . 2759572004815709E- 15  3 . 8857805861880479E- 15 

TIME,  RES  =  2,827623175A516359E-02  &.883382752A759706E-15 

-5.5511 151231257827E-1A  5.91193760&128958&E-15 

TIME,  RES  =  2.8772040280224215E-02  1,210143096841420AE-14 

-1.77635A8394002505E-15  9.5201&24361&07173E-15 

CONVERGENCE  ACHIEVED. 

IN  NOMINIA  GAUSSIAM  TRAJECTORUM  REFERENTIA 
DECLARIUM  EST  ESTIMATIA 


COVARIANCE  MATRIX  AT  EPOCH  IS! 

0 .5326076E-07-0 . 6281594E-07  0 .8771866E-07-0 . 1283216E-05  0 . 1548222E-05 
-0.2165235E-05  0.1071689E-02-0.944105AE-02 

-0.6281594E-07  0.1093351E-06-0.7830126E-07  0. 1513152E-05-0.2685997E-05 
0 . 19541 15E-05-0 . 1202959E-02  0 . 10A1479E-01 

0.8771 8AAE-07-0 . 7830 1 26E-07  0.1 62701 lE-06-0 . 2 1 09 1 02E-05  0.19641 87E-05 
-0.4044935E-05  0.1850221E-02-0.1625326E-01 

-0.1283216E-05  0.1513152E-05-0.2109102E-05  0.4921990E-04-0.5840715E-04 
0 .8144504E-04-0 .3963665E-01  0 .3502494E+00 

0 . 1 548222E-05-0 . 2685997E-05  0 . 1 964187E-05-0 . 5840715E-04  0 . 1076256E-03 
-0 . 8236889E-04  0 . 5277039E-01-0 . 4608560E+00 

-0.21 65235E-05  0.19541 15E-05-0 . 4044935E-05  0.81 44504E-04-0 . 8236889E-04 
0 . 1 66693 1 E-0 3-0 . 8 1 2 1 947E-0 1  0 . 7064677E+00 

0 . 1071689E-02-0 . 1202959E-02  0 . 1850221E-02-0 .3963665E-01  0 .5277039E-01 
-0 . 8121947E-0 1  0 . 4644291E+02-0 .3995065E+03 


-0 . 9441056E-02  0 . 1 061 479E-01-0 . 1625326E-0 1  0 . 3502494E+00-0 . 4608560E+00 
0 .7064677E+00-0 . 3995065E+03  0 . 3442251E+04 


BEGIN  NEXT  BAYES  LOOP 
FIRST  PASS  residuals; 

TIME,  RES  =  5,2073630894493458E-02  2.1186941090434175E-12 

-2 . 0283774659901 61 OE-1 3  1 . 437017171 92357 1 4E- 1 2 

TIME,  RES  =  5. 256940941820131 4E-02  2. 2054580384 178735E- 12 

-2.1016521856154213E-13  1 .4958867478043203E-12 

TIME,  RES  =  5,3065187941909170E-02  2.2940538357829610E-12 

-2.1938006966593093E-13  1 .5562828803439288E-12 

TIME,  RES  =  5. 35609664656 17026E-02  2.38453701228991 12E-12 

-2.2776225350185086E-13  1 .6183998585717063E-12 

SIGMA  IN-TRACK  =  0.1877475851419E-03 


ITERATION  1 
STATE  CORRECTIONS 

-0.45514575682E-12-0.19782258736E-11  0.30948135153E-11-0.37428283587E-10 
-0.16583823041E-09  0.25908692960E-09  0.11485310663E-09  0.24220206542E-07 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH t 

-0.13271389423E+00-0.57741586570E+00  0.80664307132E+00-0,31096134908E-02 
-0.13529406065E-01  0.25228387479E-01  0.37381700696E+00  0.34659825536E+01 


LAST  PASS  residuals; 

TIME,  RES  =  5.2073630894493458E-02  2,2204460492503131E-16 
-4 . 4408920985006262E- 16  9 . 4368957093138306E-16 
TIME,  RES  =  5,2569409418201314E-02  1.1102230246251565E-16 
3 . 3306690738754696E- 16  6 , 383782391594650 1 E- 1 6 
TIME,  RES  =  5.3065187941909170E-02  -1.6653345369377348E-16 

-6.6613381477509392E-16  6.1062266354383610E-16 
TIME,  RES  =  5.3560966465617026E-02  -3.8857805861880479E-16 

-6.6613381477509392E-16  9.7144514654701197E-16 

CONVERGENCE  ACHIEVED, 

IN  NOMINIA  GAUSSIAM  TRAJECTORUM  REFERENTIA 
DECLARIUM  EST  ESTIMATIA 


COVARIANCE  MATRIX  AT  EPOCH  IS! 

0 . 6072234E-07-0 . 7 1 47296E-07  0 . 9986768E-07-0 . 2061 610E-05  0 . 2424570E-05 
-0 , 338681 lE-05  0 ,3580830E-03-0 .31 18665E-02 


-0.7147296E-07  0,1242337E-06-0.8890348E-07  0.2424957E-05-0.4221118E-05 


0 .30258&6E-05-0 . 368681 lE-03  0 .3244705E-02 

0 ,9986768E-07-0 . 8890348E-07  0 . 1849888E-06-0 . 3386482E-05  0 . 3<'33242E-05 
-0 . 6309290E-05  0 . 6606039E-03-0 . 56771 14E-02 

-0,2061610E-05  0.2424957E-05-0.3386482E-05  0.1038010E-03-0.1212931E-03 
0. 1690747E-03-0 . 1704629E-01  0 . 1498992E+00 


0 .2424570E-05-0 . 4221 1 18E-05  0 .3033242E-05-0 . 1212931E-03  0 . 2145960E-03 
-0.1571304E-03  0.2267489E-01-0.1928854E+00 


-0 .338681 lE-05  0 .3025866E-05-0 . 6309290E-05  0 . 1690747E-03-0 , 1571304E-03 
0 .3268897E-03-0 .411 3979E-01  0 . 3424153E+00 


0 .3580830E-03-0 .368681 lE-03  0 .6606039E-03-0 . 1704629E-01  0 . 2267489E-01 
-0 . 4 1 13979E-01  0 . 1 185081E+02-0 .9033076E+02 


-0.3 1 18665E-02  0 . 3244705E-02-0 .56771 14E-02  0 . 1 498992E+00-0 . 1928854E+00 
0.3424153E+00-0.9033076E+02  0.6936491E+03 


BEGIN  NEXT  BAYES  LOOP 

FIRST  PASS  residuals: 

TIME,  RES  =  7.6862557079886247E-02  1.6542323066914832E-14 

-6.8278716014447127E-15  1 .2517764602648640E-14 

TIME,  RES  =  7.7358335603594102E-02  1 .7319479184152442E-14 

-6.8833827526759706E-15  1 .3600232051658168E-14 

TIME,  RES  =  7.7854114127301957E-O2  1.7874590696465020E-14 

-7 . 771561 1 723760958E- 15  1 . 451 6166046973922E- 1 4 

TIME,  RES  =  7.8349892651009813E-02  1.8984813721090177E-14 

-8.3266726846886741E-15  1 .4349632593280148E-14 

SIGMA  IN-TRACK  =  0.1871505838125E-03 


ITERATION  1 
STATE  CORRECTIONS 

-0.28785158617E-14-0.12297194010E-13  0.27942401834E-13  0.19573092864E-12 
-0.14096522014E-11  0.31650196992E-11-0.69360935084E-10  0. 69987391 lOOE-09 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH: 

-0 . 132B0006717E+00-0 .57779078968E+00  0 . 80746713138E+00-0 . 37386480479E-02 
-0.16266229781E-01  0.42310351301E-01  0.373B1700689E+00  0.34659825543E+01 


LAST  PASS  residuals: 

TIME,  RES  =  7.6862557079886247E-02  5.5511151231257827E-17 

-1.6653345369377348E-16  4.4408920985006262E-16 

TIME,  RES  =  7.7358335603594102E-02  1.1102230246251565E-16 


1 .6653345369377348E-16  B.3266726846886741E-16 
TIME,  RES  =  7.7854114127301957E-02  O.OOOOOOOOOOOOOOOOE400 
-4.4408920985006262E-16  9.7144514654701197E-16 

TIME,  RES  =  7.8349892651009813E-02  3.8857805861880479E-16 
-5.5511 151231257827E-16  8.3266726846886741E-17 

CONVERGENCE  ACHIEVED, 

IN  NOMINIA  GAUSSIAM  TRAJECTORUM  REFERENTIA 
DECLARIUM  EST  ESTIMATIA 


COVARIANCE  MATRIX  AT  EPOCH  IS.* 

0 .6564928E-07-0 .7715554E-07  0 . 1078736E-06-0 .2641064E-05  0 .3100390E-05 
-0 , 4331 122E-05  0.1 026425E-03-0 . 9849005E-03 

-0.7715554E-07  0.1340107E-0&-0.9580887E-07  0 .3102206E-05-0 .5391204E-05 
0 . 3857853E-05-0 . 8962399E-04  0.911 6841E-03 

0 . 1078736E-0A-0 . 9580887E-07  0 . 1996734E-0<v-0 . 4336550E-05  0 . 3862641E-05 
-0. 8056665E-05  0 . 21981 14E-03-0 . 1978954E-02 

-  0 . 2641064E-05  0 . 310220<4E-05-0 . 433A550E-05  0 . 1521423E-03-0 . 1 780296E-03 
0.2482631E-03-0.5264764E-02  0.525&244E-01 

0.3100390E-05-0.5391204E-05  0.3862641E-05-0.1780296E-03  0.3116213E-03 
- 0. 2261788E-03  0 , 7947383E-02-0 ,7029946E-01 

- 0 . 4331 122E-05  0 . 3857853E-05-0.8056665E-05  0 . 2482631E-03-0 . 2261788E-03 
0.4752676E-03-0.2021447E-OI  0.1 62261 3E-f 00 


0.1026425E-03-0.8962399E-04  0.2198114E-03-0.5264764E-02  0.79473B3E-02 
-0.2021447E-0}  0 .6560231F.+01-0,4295668E+02 


-0.9849005E-03  0.9116841E-03-0.1978954E-02  0.5256244E-01-0 .7029946E-01 
0 . 1622613E+00-0 . 4295668E+02  0 .2835853E+03 


i 


I 


SIGMA  IN-TRACK  =  0 . 1617379723854E-03 

LAST  GOOD  VALUES  FOR  THE  MAIN  STATE  VECTOR 

-0.13273855504E+00  -0 .57752316071E+00  0.82341630058E+00  0.10999752528E-01 

0.47858075971E-01  0.2A2493A4632E+00  0.37381700697E+00  0,34A59825541E+01 

NONLINEAR  LS  STAGING  ESTIMATOR 

INITIAL  GUESS  IS  t 

VEDiM  =  0.98000000000E+00  TSTAGE  =  0.20450000000E+00 

a  INVERSE,  A  1  X  1  MATRIX,  IS  : 

0.33227510069EF03 
FIRST  PASS  RESIDUALS  : 

RESIDUAL  =  -0. 34908531 199E-04 

RESIDUAL  =  -0.38484A45040E-04 

RESIDUAL  =  -0.42303032656E-04 

RESIDUAL  =  -0.46372S17240E-04 

RESIDUAL  =  -0.50703258280E-04 

P  INVERSE  MATRIX  IS  t 

0 , 1 J.  2:'4RT50P8E-'r02  0 . 3489881 0099E+04 
0.34898R100?'^E+04  0.  l08865='.6"’5IE+07 

p  matrix  is  : 

0 . 1 14Tt.361360E+02  -0 . 36789534553F-01 

-0.3a789534553E-01  0. 11985401506E-03 

ITERATION  1 

STATE  CORRECTIONS 


-O.A4785121011E+00  0.10489440517E-02 


CURRENT  STAGING  STATE  VECTOR 

VE»M  =  0.33214878989E+00  TSTA6E  =  0.20554894405E+00 

RESIDUAL  =  -0.96466498137E-06 

RESIDUAL  =  -0.221650584UE-05 

RESIDUAL  =  -0.41530309191E-05 

RESIDUAL  =  -0.54014984A29E-05 

RESIDUAL  =  -0.67672831894E-05 

P  INVERSE  MATRIX  IS  t 

0 . 1 1724070832E+02  0 .54152808843E+04 

0 .54 152808843E+04  0 . 27073976235E+07 

P  MATRIX  IS  : 

0,11204008500E+01  -0.22410026710E-02 

-0 . 22410026710E-02  0 . 48517657000E-05 

ITERATION  2 

STATE  CORRECTIONS 

0.16147025867E+00  -0. 55B65780433E-03 

CURRENT  STAGING  STATE  VECTOR 

VE*M  =  0,49361904856E+00  TSTAGE  =  0.20499028625E+00 

RESIDUAL  =  0.91174165950E-07 

RESIDUAL  =  -0.97301836928E-06 

RESIDUAL  =  -0.11480209913E-05 

RESIDUAL  =  -0.20544599332E-05 

RESIDUAL  =  -0.23195934440E-05 

P  INVERSE  MATRIX  IS  *. 

0 . 13474499585E402  0 . 57280692571E+04 

0 .57280692571E+04  0 . 26386050221E+07 

P  MATRIX  IS  ; 

0,96190454109E+00  -0.20881699928E-02 
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-0.20881699928E-02  0.49121343403E-05 

ITERATION  3 
STATE  CORRECTIONS 

-0 . 57025938159E-02  -0 . 43268247548E-05 

CURRENT  STAGING  STATE  VECTOR 

VE»M  =  0.48791645474E+00  TSTAGE  *  0.20498595942E+00 

LAST  PASS  RESIDUALS  5 

RESIDUAL  =  0.87A96189093E-07 

RESIDUAL  =  -0.9&808340799E-OA 

RESIDUAL  =  -0.11333257606E-05 

RESIDUAL  =  -0.20286571019E-05 

RESIDUAL  =  -0.22813356807E-05 

CONVERGENCE  HAS  BEEN  ACHEIVED 
COVARIENCE  MATRIX  : 

0 .96190454109E+00  -0 ♦ 20881699928E-02 
-0.20881699928E-02  0.49121343403E-05 

BEGIN  ESTIMATION  OF  THE  NEXT  STAGE 
STAGING  OCCURED  AT  I  165.3855  SECONDS 

AT  THE  START  OF  THE  NEXT  STAGE  THE 
COVARIANCE  MATRIX  AT  EPOCH  ISt 

0 ,4565959E-07-0 . 5268B02E-07  0 . 7443739E-07-0 , 2753388E-05  0 . 3148689E-05 
0 . 4606050E-05-0 . 9374819E-05  0 , 6697224E-05 

•0.526Be02E-07  0,9109443E-07-0,6435272E-07  0.3178810E-05-0.5453415E-05 
0,4053552E-05  0.3108699E-05  0.8351015E-05 

0 ,7443739E-07-0 .6435272E-07  0 , 1372751E-06-0 .4465468E-05  0 . 3891761E-05 
■0,8051657E-05-0.4561439E-04  0.1035079E-03 

■0 . 2753388E-05  0 .3178810E-05-0. 4465468E-05  0 , 2983318E-03-0.3381989E-03 
0,5072766E-03  0.3611681E-03  0,1397353E-02 

0.3148689E-05-0.5453415E-05  0.3891761E-05-0,3381989E-03  0.5910273E-03 
•0 . 3924988E-03-0 , 3158587E-02  0 . 8328221E-02 


-0 ♦ 4606050E-05  0 . 4053552E-05-0 . 8051657E-05  0 . 5072766E-03-0 . 3924988E-03 
0 . 1 144375E-02-0 . 1310467E-01  0 . 4760086E-01 


-0.9374819E-05  0.3108&99E-05-0.4561439E-04  0.3611681E-03-0.3158587E-02 
-0.1310467E-01  0.2204885E+01-0.3579046E+01 

0.6&97224E-05  0.8351015E-05  0.1035079E-03  0.1397353E-02  0.8328221E-02 
0 . 47&0086E-0 1-0 . 357904&E+0 1  0 . 2032392E+02 


INITIAL  STATE  VECTOR  IS: 

-0.13268644573E+00-0.57729644189E+00  0.824&2090473E+00  0,12371&39351E-01 
0,5382&925144E-01  0.277595804<SlE+00  0.37381700A97E+00  0.1 30522808 12E+01 

FIRST  PASS  residuals: 

TIME,  RES  =  0.2052A9 19472022 11  -1 .7598803359053505E-07 

4.61356399250A0090E-07  -1 .84546&2573108571E-07 
TIME,  RES  =  0.2057649732439289  -1.0882111289856056E-07 

2.8503683480174402E-07  -1.1407825081799494E-07 
TIME,  RES  =  0.2062607517676368  -2.3800984788602264E-07 

6.2183238963564591E-07  -2.4927168426613910E-07 
TIME,  RES  =  0.2067565302913446  -1 .8806796192594177E-07 

4.8889777853888816E-07  -1 .9660017203104729E-07 

ITERATION  1 

STATE  CORRECTIONS 

0.20038276788E-05  0.33939718523E-05  0.80176544096E-05-0.88864796533E-04 
-0.37381172947E-03-0.12193851790E-02-0.44828781693E+00  0.22984568451E+01 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH: 

-0.13268444191E+00-0.57729304791E+00  0.82462892238E+00  0.122B2774554E-01 
0.53453113414E-01  0.27637641943E+00-0.74470809967E-01  0.36036849263E+01 

TIME,  RES  =  0.2052691947202211  -2.9219953961989731E-07 

7.2263151770779466E-06  -2.2355961721565176E-06 
TIME,  RES  =  0.2057649732439289  -1 .503B931544530953E-08 

6.3548217317799249E-06  -1 .9221591553431061E-06 
TIME,  RES  =  0.2062607517676368  1 .1629122553813431E-07 

5.8636362288977395E-06  -1 .7613384180326097E-06 
TIME,  RES  =  0.2067565302913446  4.7724226143186499E-07 

4 .7696948324293942E-06  -1 .3595958135159680E-06 

ITERATION  2 

STATE  CORRECTIONS 

-0 . 2757 1934039E-06  0 . 30503223808E-04  0 . 18352567639E-04-0 . 16675382008E-03 
-0 . 1 29437852B6E-02-0 . 667807481 79E-03  0 . 2021 2795672E+00-0 . 35642334244E+01 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH*. 
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-0 . 1 326847 17&3E+00-0 . 57726254469E+00  0 .B2464727495E+00  0 . 121 16020734E-01 
0.52158734885E-01  0.27570861194E+00  0. 1276571 4676E+00  0.39451501963E-01 

TIME,  RES  =  0.2052691947202211  4.7391326235546316E-07 

4,182141 6475573692E-05  - 1 . 246871 8335323370E-06 
TIME,  RES  =  0.2057649732439289  6.0427764392301242E-07 

4.0308031349856055E-05  -9.8531632564125005E-07 
TIME,  RES  =  0.2062607517676368  5. 70594961 11344643E-07 

3 .9223181 106773364E-05  -8 . 9550706444674333E-07 
TIME,  RES  *  0.2067565302913446  7.4831656843299399E-07 

3 . 75839 1 5060535045E-05  -5 . 8392349766567264E-07 

ITERATION  3 

STATE  CORRECTIONS 

0.23015725778E-04-0.37869792058E-04  0.43905035797E-04-0.24302742204E-03 
0,58437473522E-03-0.30457235393E-02  0.57528015299E+00  0.87214084988E+01 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH! 

-0.13266170190E+00-0.57730041448E+00  0.82469117999E+00  0.11872993312E-01 
0.52743109621E-01  0.27266288840E400  0.70293729974E+00  0.87608600007E+01 

TIME,  RES  =  0.2052691947202211  -4.5414986651337585E-06 

3 .5884931 1 60 190536E-05  -2.841991 80 19273460E-05 
TIME,  RES  =  0.2057649732439289  -4.5110060472031144E-06 

3.5363895264040046E-05  -2.8222524700083351E-05 
TIME,  RES  =>  0.2062607517676368  -5. 05854738 13646864E-06 

3. 63590701 17175651E-05  -2,8630326952577834E-05 
TIME,  RES  =  0.2067565302913446  -5,809780502B523020E-06 

3 . 7892908763326 1 83E-05  -2 . 9251 347657577309E-05 

ITERATION  4 

STATE  CORRECTIONS 

-0 . 47376315002E-05  0 . 26050625553E-03  0 . 164571 67369E-03-0 . 90223993991E-03 
-0.69422899610E-02-0.54535944618E-02-0.63457005756E+00  0.86117518823E-01 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH’. 

-0 . 13266643953E+00-0 . 57703990823E+00  0 . 824B5575166E+00  0 . 10970753372E-0 1 
0.45800819660E-01  0.26720929394E+00  0.68367242181E-01  0.88469775195E+01 

TIME,  RES  =  0.2052691947202211  -2,0504869135962167E-06 

3.3682774033860774E-04  -2.1425934319613260E-05 
TIME,  RES  *  0,2057649732439289  -1 .77023B7292706234E-06 

3 .30472934052861 16E-04  -2 .0470209393913530E-05 
TIME,  RES  =  0.2062607517676368  -1 .6952127908087533E-06 

3,2465169305578B56E-04  -1 ,9728983019801083E-05 
TIME,  RES  =  0.2067565302913446  -1 .4500715173060286E-06 

3 , 1 83815985 1 843573E-04  - 1 , 8808890836885528E-05 

ITERATION  5 

STATE  CORRECTIONS 
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-0.40834119701E-04-0.24A241&9460E-03-0.28607695188E-03  0.17593223190E-02 
0.83301264799E-02  0. 12693161187E-01  0.45668740767E-01-0.99248141841E400 


CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH t 

-0 . 13270727365E+00-0 . 5772861 4992E+00  0 . 82456967471E+00  0 . 12730075691E-01 
0.54130946140E-01  0.27990245513E+00  0,11403598295E+00  0,78544961011E+01 

TIME,  RES  =  0.2052691947202211  2.4399115843842800E-06 

- 1 . 950306429121 5289E-05  2 . 263581 7943039704E-05 

TIME,  RES  =  0.2057649732439289  2.2472561511666100E-06 

- 1 . 879153097605890 lE-05  2 . 2289555254406679E-05 

TIME,  RES  =  0.2062607517676368  1 .8307841617715148E-06 

-1.7494805797935165E-05  2.1708640520090583E-05 

TIME,  RES  =  0.2067565302913446  1. 56581 42074603809E-06 

- 1 .659512698842791 lE-05  2 . 128639774021 1 127E-05 

ITERATION  6 

STATE  CORRECTIONS 

0 . 1 0507203167E-04-0 . 35129799128E-05  0 .26891823228E-04-0 . 21070100278E-03 
-0.27545921954E-03-0.14811362808E-02  0.31840294636E-01-0.88195695331E+00 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH! 

-0 . 1 3269676645E+00-0 . 57728966290E+00  0 . 82459656653E+00  0 . 12519374688E-01 
0.53855486920E-01  0.27842131885E+00  0.14587627758E+00  0.69725391478E+01 

TIME,  RES  *  0.2052691947202211  1 .1875026073582262E-06 

-7.5781260988061483E-06  1 .1193513702822955E-05 

TIME,  RES  =  0.2057649732439289  1.1219403288076357E-06 

-7 . 3673571 1 1 2653491E-06  1 . 1063438363573264E-05 

TIME,  RES  *  0.2062607517676368  8.2446289273452322E-07 

-6.5498630418270309E-06  1 .0690255173556595E-05 

TIME,  RES  *  0.2067565302913446  6.7040174583921086E-07 

-6. 107865036741B774E-06  1 .0467294250443571E-05 

ITERATION  7 

STATE  CORRECTIONS 

0.45282446528E-05-0.17805747867E-05  0.1150060432BE-04-0.84986911286E-04 
-0.1 0985697500E-03-0 . 70350535860E-03  0 . 2996911 3786E-01 -0 .86443911 4 12E+00 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH! 

-0. 13269223820E+00-0 .57729144348E+00  0 . 82460806714E+00  0 . 12434387777E-01 
0.53745629945E-01  0.27771781349E+00  0.17584539137E+00  0.61081000337E+01 

TIME,  RES  =  0,2052691947202211  6.26838292050457B2E-07 

-2.7210963581270065E-06  6.2412938401090745E-06 

TIME,  RES  =  0,2057649732439289  6.3119578980197488E-07 

-2.7397270758733328E-06  6.2148962306773914E-06 

TIME,  RES  =  0.2062607517676368  3.9987773675642657E-07 

-2.141 5962865867222E-06  5.941 460258201 9693E-06 

TIME,  RES  =  0.2067565302913446  3.0824053609546098E-07 

- 1 . 9089668261 140780E-06  5 . 81433876944981 17E-06 
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ITERATION  8 
STATE  CORRECTIONS 

0 ,27462066960E-05-0 . 16196496&88E-05  0 . 64930225075E-05-0 . 49263870709E-04 
-0 . 52349352002E-04-0 . 423492281 80E-03  0 . 33989498929E-01-0 . 84834004228E+00 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH*. 

-0 . 132&8949200E+00-0 .5772930A312E+00  0 . 8246145&016E+00  0 . 12385123906E-01 
0,53693280593E-01  0.27729432121E400  0.20983489030E+00  0.52597599914E+01 

TIME,  RES  =  0.2052A91947202211  3.2&62703369767954E-07 

-4 , B302972865954530E-07  3 . 2730765318900179E-0& 

TIME,  RES  =  0.2057&49732439289  3.7&19291826107570E-07 

-6.3535&50890456097E-07  3.3109929015728845E-06 
TIME,  RES  =  0.2062&07517676368  1 .8815782515391177E-07 

-l,6575278327A57372E-07  3.0998A04212129077E-0& 

TIME,  RES  =  0.20A75&530291344&  1 .379072681 6065302E-07 

-5 . 6545598259294394E-08  3 .0330607325157466E-06 

ITERATION  9 

STATE  CORRECTIONS 

0 . 1 7456386769E-05-0 . 13243255458E-05  0 . 3B376762756E-05-0 . 3004646782BE-04 
-0.23521096371E-04-0.26020761701E-03  0.391012B5B21E-01-0.79200343418E+00 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH} 

-0 . 13268774636E+00-0 .57729438745E+00  0 . 82461839784E+00  0 . 12355077438E-01 
0.53669759497E-01  0. 2770341 1359E+00  0.24893617612E400  0.44677565572E401 

TIME,  RES  =  0.2052691947202211  1 .6650548079200078E-07 

5.4025141882352301E-07  1 .4134803224541415E-06 

TIME,  RES  =  0.2057649732439289  2. 46045404495021 lOE-07 

3.0673904155564813E-07  1 .492910323B081609E-06 

TIME,  RES  =  0.2062607517676368  8.7467600273782864E-08 

6 . 965885032 1 285826E-07  1 . 322756573940431 2E-06 

TIME,  RES  =  0.2067565302913446  6.6186762237574470E-08 

7.2739946194166905E-07  1 .2964309033525190E-06 

ITERATION  10 

STATE  CORRECTIONS 

0 . 10603764230E-05-0 . 10072700699E-05  0 . 21323986734E-05-0 . 171236B4359E-04 
-0.6594291 751 6E-05-0.14797275235E -03  0.42631230537E-01-0.68538704227E400 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH*. 

-0.13268668598E400-0.57729539472E400  0.82462053023E400  0.12337953754E-01 
0.53663165205E-01  0. 2768861 4084E400  0.29156740666E400  0.37823695150E401 

TIME,  RES  =  0.2052691947202211  8.9963929583714020E-08 

8.8821583910103641E-07  3.02121 14698B90957E-07 

TIME,  RES  =  0.2057649732439289  1 .8883654445689402E-07 

6.0753817388015108E-07  4.0744013396487588E-07 
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TIME,  RES  =  0.2062607517676368  5.0262238093790046E-08 

9 . 48502374920057 18E-07  2 . 6388474264060768E-07 
TIME,  RES  =  0.2067565302913446  4.9681373959220565E-08 

9.2863658163189200E-07  2.6489442100929850E-07 

ITERATION  11 

STATE  CORRECTIONS 

0 . 58996260430E-06-0 . 70578848871E-06  0 . 10482445708E-05-0 . 852371 78722E-05 
0.23280853620E-05-0.73132681392E-04  0.41273070469E-01-0.53394777626E+00 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH! 

-0 . 13268609602E+00-0 . 57729610051E+00  0 . 82462157848E+00  0 . 12329430036E-01 
0.53665493290E-01  0.27681300816E+00  0.33284047713E400  0.32484217387E+01 

TIME,  RES  =  0.2052691947202211  6.0640900689801214E-08 

8.8837447198564234E-07  -3.0461209196697148E-07 
TIME,  RES  =  0.2057649732439289  1.7146500902454065E-07 

5.8217127352211406E-07  -1 .8406224897016266E-07 
TIME,  RES  =  0.2062607517676368  4.6319588387078170E-08 

8.9374617534554446E-07  -3.1083238671847369E-07 
TIME,  RES  =  0.2067565302913446  6.0664519019315577E-08 

8.4056694926726294E-07  -2.91461 14530198552E-07 

ITERATION  12 

STATE  CORRECTIONS 

0 .28998682333E-06-0 . 43840345484E-06  0 . 43033729400E-06-0 . 34599302786E-05 
0.51 201 809984E-05-0 . 2926831 9344E-04  0 . 32436272978E-01-0 . 36206691 855E+00 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH! 

-0.13268580603E+00-0.57729653891E+00  0.82462200882E+00  0.12325970106E-01 
0.53670613471E-01  0.27678373984E+00  0,36527675010E+00  0.28863548202E+01 

TIME,  RES  =  0.2052691947202211  5.3933016830320923E-08 

7.6769076678973036E-07  -5.9613180070083871E-07 
TIME,  RES  =  0.2057649732439289  1 .7188626821873498E-07 

4.4815B25739341619E-07  -4.6708128476069533E-07 
TIME,  RES  =  0,2062607517676368  5.5687559397110675E-08 

7.4162944524447383E-07  -5.8344026510059877E-07 
TIME,  RES  =  0,2067565302913446  8.080928881604165BE-08 

6,6552803729136301E-07  -5,5173250532170037E-07 

ITERATION  13 

STATE  CORRECTIONS 

0.12376820450E-06-0.23383871789E-06  0,141B2331423E-06-0.10582554321E-05 
0.42769895741E-05-0,87921392544E-05  0.18714176057E-01-0.20847732406E+00 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH! 

-0 . 13268568226E+00-0 , 57729677275E+00  0 . 82462215064E+00  0 . 1232491 1851E-01 
0.53674890461E-01  0.27677494770E+00  0.38399092616E+00  0.26778774961E+01 
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TIME,  RES  =  0.2052691947202211  5,4631764945245465E-08 

6 .5492717438164760E-07  -7 . 174479252081 1451E-07 
TIME,  RES  =  0.2057649732439289  1 .7687019582268704E-07 

3.2776504704790099E-07  ~5. 836382976354 1375E-07 
TIME,  RES  =  0.2062607517676368  6.6707010193400862E-08 

6.0900014425824267E-07  -6.9339883737584707E-07 
TIME,  RES  =  0.2067565302913446  9.9621225546631109E-08 

5.1602805162254128E-07  -6.5324469727956469E-07 

ITERATION  14 

STATE  CORRECTIONS 

0.48279953112E-07-0.10622107547E-06  0.42912852018E-07-0.24629428053E-06 
0 .23639967496E-05-0 . 20809080210E-05  0 . 746871 75556E-02-0 . 10206843599E+00 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH*. 

-0 . 1 3268563398E+00-0 . 57729687897E+00  0 . 82462219355E+00  0 . 1 2324665556E-0 1 
0.53677254458E-01  0.27677286679E+00  0.39145964372E+00  0.25758090601E+01 

TIME,  RES  =  0.2052691947202211  5.5829807332763437E-08 

5.91 46098457807383E-07  - 7 . 6395602596757 1 51 E-07 
TIME,  RES  =  0.2057649732439289  1 .8063973156179358E-07 

2.5940551456882233E-07  -6.2741481302031055E-07 
TIME,  RES  =  0.2062607517676368  7.4385618331618275E-08 

5.3222403051389477E-07  -7.3303826689241625E-07 
TIME,  RES  =  0.2067565302913446  1.1254937370974716E-07 

4 .2729634863736266E-07  -6 . 8733724140068730E-07 

ITERATION  15 

STATE  CORRECTIONS 

0 . 19346769542E-07-0 . 4021 4963482E-07  0 . 19492436541E-07-0 . 83724255878E-07 
0.87726966731E-06-0.73216464608E-06  0.21295397734E-02-0.43621235338E-01 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH: 

-0.13268561464E+00-0.57729691919E+00  0.82462221305E+00  0. 12324581832E-01 
0,53678131727E-01  0.27677213463E400  0.39358918349E+00  0,25321878248E+01 

TIME,  RES  =  0.2052691947202211  5.6175996687723995E-08 

5 , 6B92659694440795E-07  -7 . 8270282868B86376E-07 
TIME,  RES  =  0.2057649732439289  1 .8236455312514721E-07 

2.3393937437221624E-07  -6.4470544292039023E-07 
TIME,  RES  =  0.2062607517676368  7.8271107317728905E-08 

5.0176536431356666E-07  -7.4805096064722854E-07 
TIME,  RES  =  0.2067565302913446  1 .1937865856959107E-07 

3 . 8977673533224788E-07  -6 . 9924834877888031 E-07 

ITERATION  16 

STATE  CORRECTIONS 

0.81211831085E-08-0.12598958297E-07  0.11723010580E-07-0.54618731079E-07 
0 . 1 9929757142E-06-0 . 44818448634E-06  0 . 4882B749549E-03-0 . 16912789047E-01 


CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH: 

-0.13268560652E+00-0.57729693179E+00  0.82462222477E+00  0,12324527213E-01 
0.53678331025E-01  0.27A77168A44E+00  0.39407747098E+00  0.25152750357E+01 


LAST  PASS  residuals: 

TIME,  RES  =  0.2052691947202211  5.6140200099807913E-08 

5,648154652870S293E-07  -7.9072711509087235E-07 
TIME,  RES  =  0.2057649732439289  1 .8295497461462418E-07 

2 . 28351041 79774746E-07  -6 . 52058061 73973535E-07 
TIME,  RES  =  0.2062607517676368  7.9850859813213049E-08 

4.9374274563307452E-07  -7.5435033458637335E-07 
TIME,  RES  =  0.2067565302913446  1 .2231124063566412E-07 

3 .7835951577358529E-07  -7 . 041 1215258303628E-07 

CONVERGENCE  ACHIEVED, 

IN  NOMINIA  GAUSSIAM  TRAJECTORUM  REFERENTIA 
DECLARIUM  EST  ESTIMATIA 


COVARIANCE  MATRIX  AT  EPOCH  IS: 

0 . 1079787E-07-0 . 1225581E-07  0 . 1772386E-07-0 . 1 447159E-06  0 . 1602750E-06 
-0 . 2496890E-06-0 . 2348063E-08-0 . 6429218E-06 

-0.1225581E-07  0.2124281E-07-0.1493236E-07  0. 1622052E-06-0,2801692E-06 
0 .2050094E-06  0 . 1983228E-06-0 .3293695E-06 

0 . 1772386E-07-0 . 1493236E-07  0 .3278480E-07-0 . 2391059E-06  0 . 1931286E-06 
-0 . 4677527E-06  0 , 3945482E-06-0 , 27431 4 lE-05 

-0,1447159E-06  0.1622052E-06-0.2391059E-06  0.3139827E-05-0. 33971 13E-05 
0.5404993E-05  0 .3222079E-05  0.1483250E-05 

0.1602750E-06-0.2801692E-06  0.1931286E-06-0.3397113E-05  0.5910122E-05 
-0.4142106E-05-0.2041358E-04  0.6798370E-04 

-0 . 2496890E-06  0 .2050094E-06-0 .4677527E-06  0 .5404993E-05-0 . 4142106E-05 
0 . 1 084129E-04-0 , 5382845E-04  0 . 2265523E-03 

-0.2348063E-08  0. 1983228E-06  0.3945482E-06  0,3222079E-05-0.2041358E-04 
-0 . 5382845E-04  0 , 1 185246E-01-0 , 4420482E-01 

-0 ,6429218E-06-0 . 3293695E-06-0 . 27431 41E-05  0 . 1483250E-05  0 , 6798370E-04 
0 , 2265523E-03-0 . 4420482E-01  0 . 1650555E+00 


BEGIN  NEXT  BAYES  LOOP 
FIRST  PASS  residuals: 

TIME,  RES  =  0,3044248994617925  -4.9224095739486273E-06 

1 ,4540944553331769E-05  -4.9643154554079860E-06 
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TIHE,  RES  =  0.3049206779855004  -4. 972169151 9066802E-06 

1 .4696157399407550E-05  -5.0135599591327740E-06 
TIME,  RES  =  0.3054164565092082  -5.0221998129096335E-06 

1. 485241 1764687545E-05  -5.0631341166340604E-06 
TIME,  RES  =  0.3059122350329161  -5.0725020753206174E-06 

1. 500971131929151 9E-05  -5.11 30388901 976520E-06 

SI6M6  IN-TRACK  =  0.1435904620022E-03 


ITERATION  1 
STATE  CORRECTIONS 

-0 . 57324734695E-06-0 . 5632 1 398532E-05-0 . 1 7989634 1 1 lE-04-0 . 21 4 17682370E-04 
-0.13433555640E-03-0.39669292481E-03-0.58351998798E-03-0.33130827796E-02 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH: 

-0. 13052106186E+00-0 .56787575007E+00  0 . 85331332950E+00  0 . 32561688754E-01 
0.14171091146E400  0.30575358323E+00  0. 393493951 OOE+00  0.25119619529E+01 


LAST  PASS  residuals: 

TIME,  RES  *  0.3044248994617925  -8.0159456850026345E-10 

8. 677564322656650 lE-08  -1.0527850138B86130E-07 
TIME,  RES  =  0.3049206779855004  -7.9473033709476226E-10 

8. 32769061 48732621E-08  -1 ,0112640433379561E-07 
TIME,  RES  =  0.3054164565092082  -B.3369972037061757E-10 

8 . 00355741 1 2624630E-08  -9 . 7036861212984604E-08 
TIME,  RES  =  0.3059122350329161  -9.1863733286956517E-10 

7.7053279368133332E-08  -9.3010209784027964E-08 

CONVERGENCE  ACHIEVED. 

IN  NOMINIA  OAUSSIAM  TRAJECTORUM  REFERENTIA 
DECLARIUM  EST  ESTIMATIA 


COVARIANCE  MATRIX  AT  EPOCH  IS.’ 

0 . 1585192E-07-0 . 1681237E-07  0 .2596656E-07  0 . 1 645801E-06-0 . 1820072E-06 
0.2606930E-06  0.2744042E-05-0.917128BE-05 

-0.1681237E-07  0.2912212E-07-0.2004902E-07-0. 1710534E-06  0.3030319E-06 
-0.1 780557E-06  0 . 9632062E-05-0 . 3328872E-04 

0 . 2596656E-07-0 . 2004902E-07  0 . 4759651E-07  0 . 27 16153E-06-0 . 2266942E-06 
0 . 4794270E-06  0 . 8102480E-05-0 . 2746308E-04 

0 . 1645801E-06-0 . 1710534E-06  0 . 2716153E-06  0 . 5013273E-05-0 . 5737872E-05 
0 . 7895331E-05  0 . 2669922E-04-0 . 794343BE-04 


» 
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-0 . 1 820072E-06  0 . 30303 19E-06-0 . 2266942E-06-0 . 5737872E-05  0 . 99469 17E-05 
-0. 6554189E-05  0 . 4981 182E-04-0 . 1722300E-03 


I  i 


0.2606930E-06-0. 1780557E-0&  0.4794270E-06  0.7895331E-05-0.6554189E-05 
0 . 1 627753E-04  0.11 04036E-02-0 . 3763694E-02 

0.2744042E-05  0.9632062E-05  0.8102480E-05  0.2669922E-04  0.4981182E-04 
0.11 04036E-02  0 . 544371 6E+00-0 . 1873802E+0 1 

-0 . 9171 288E-05-0 . 3328872E-04-0 . 274&308E-04-0 . 7943438E-04-0 . 1 722300E-03 
-0 . 3763694E-02-0 . 1 873802E+0 1  0 . 6450348E+01 


BEGIN  NEXT  BAYES  LOOP 
FIRST  PASS  RESIDUALS*. 

TIME,  RES  =  0.3292138256471854  -5. 931 926361 2245265E-08 

2.6143103615261509E-07  1 ,8594920769832157E-08 

TIME,  RES  =  0.3297096041708932  -6. 177579681 1325279E-08 

2.7299977201078462E-07  1 .9164278108885213E-08 

TIME,  RES  =  0.3302053826946011  -6.4285348488901661E-08 

2.8492028741888831E-07  1 .9651562793709942E-08 

TIME,  RES  =  0.3307011612183089  -6. 68480740206867 lOE-08 

2 . 97 19476857259508E-07  2 . 0056325045203494E-08 

SIGMA  IN-TRACK  =  0.1394791557341E-03 


ITERATION  1 
STATE  CORRECTIONS 

0 . 16323901097E-06-0 . 26782727494E-06  0 . 56066876744E-07-0 . 14749691843E-05 
-0.17008749189E-04-0.27866994489E-04  0. 14997277274E-02-0.54661823943E-02 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH.* 

-0.12963595979E+00-0.56402474404E+00  0.86102713523E+00  0.38941263446E-01 
0.16946091568E+00  0.31686960999E+00  0.39499367872E+00  0.25064957705E+01 


LAST  PASS  residuals: 

TIME,  RES  =  0.3292138256471854  -6.5864208531607460E-10 

5.9084605097403653E-08  -8.7929414083198765E-08 
TIME,  RES  =  0.3297096041708932  -6.4851879422178627E-10 

5.6725218244846332E-08  -8.4526881632962514E-08 
TIME,  RES  =  0.3302053826946011  -7.1473549301259709E-10 

5.4911018065872952E-08  -8.1252781530816165E-08 
TIME,  RES  =  0.3307011612183089  -8.5712947850424825E-10 

5.3642841335577174E-08  -7,8107164319662914E-08 

CONVERGENCE  ACHIEVED. 

IN  NOMINIA  6AUSSIAM  TRAJECTORUM  REFERENTIA 
DECLARIUM  EST  ESTIMATIA 


COVARIANCE  MATRIX  AT  EPOCH  IS*. 

0.1678104E-07-0.1731438E-07  0.27A0746E-07  0.1482B14E-06-0.1705411E-06 
0 . 2307402E-06  0 . 3595634E-05-0 . 1 1668A7E-04 

-0. 173143BE-07  0.3042083E-07-0.2019684E-07-0. 1553359E-06  0.2600475E-06 
-0.1577965E-06  0.1396917E-04-0.4591884E-04 

0 . 2760746E-07-0 . 2019684E-07  0 .5088432E-07  0 . 242771.8E-06-0 . 2246380E-06 
0 .42428&9E-06  0 . 1439888E-04-0 .470981 3E-04 

0 . 1 48281 4E-06-0 . 1 553359E-06  0 . 2427718E-06  0 . 3596756E-05-0 . 40842B7E-05 
0 .5493277E-05-0 . 5341215E-04  0 . 1825690E-03 

-0 . 1 7054 1 lE-06  0 . 2600475E-06-0 . 224&380E-06-0 . 40842B7E-05  0 . 74A0535E-05 
-0 . 4999785E-05-0 . 2825622E-03  0 . 9302488E-03 

0 .2307402E-06-0 . 1577965E-06  0 .4242869E-06  0 .5493277E-05-0,4999785E-05 
0 , 1 047509E-04  0 . 3844328E-03-0 . 123<S842E-02 

0 , 3595634E-05  0 . 1396917E-04  0 . 1439888E-04-0 . 5341215E-04-0 . 2825622E-03 
0 .3844328E-03  0 . 3208594E+00-0 . 1053370E+01 

-0 . 1 166867E-04-0 . 4591884E-04-0 .4709813E-04  0 . 1825690E-03  0 , 9302488E-03 
-0. 1236842E-02-0. 1053370E+01  0.3458475E+01 


Land  Base  Sensor 


NONLINEAR  BAYES  FILTER 


INITIAL  STATE  WECTOR  t 

-0.1 32&0000000E+00-0 . 57700000000E+00  0 . 80590000000E+00-0 , 10230000000E-02 

-0.44490000000E-02  0.62640000000E-02  0.373BOOOOOOOE-hOO  0.34660000000E-f01 

INITIAL  TIME  :  0.002000  *  OF  DATA  POINTS  :  0 

MAX  LS  ITERATIONS  :  20  «  OF  BAYES  CHUNKS  I  50 

MAX  BAYES  ITERATIONS  :  20  RANK  OF  P  *.  8 

BETA  MATRIX  =  1.000  1.000  1.000  1.000  1.000  1.000  1.000  1.000 

FIRST  PASS  residuals: 

TIME,  RES  =  2.4957785237078558E-03  1.844B5178&2253849E-05 

-2.3190001380A13001E-04  3.1130970579A43438E-05 

TIME,  RES  =  2.9915570474157117E-03  1.8448704051893944E-05 

-2 . 3192109328873389E-04  3 . 1 158&39407858138E-05 

TIME,  RES  =  3. 487335571 1235A75E-03  1. 84488702598337 16E-05 

-2.319441970971558AE-04  3.11863564999&7455E-05 

TIME,  RES  =  3.9831140948314234E-03  1. 844901 4879344527E-05 

-2.3196945539A60785E-04  3.1214121150570373E-05 

ITERATION  1 

STATE  CORRECTIONS 

-0.11314297351E-04  0.30462368A08E-04  0.282B0026399E-04  0.40358834297E-06 
-0.13249647A90E-0A  0. 12799220A5&E-04  0.10156564167E-03-0.781970156B2E-03 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH*, 

-0 . 13261 131430E+00-0 ,57696953763E+00  0 . 80592828003E+00-0 . 102259641 17E-02 
-0.44491324965E-02  0.62767992207E-02  0.37390156564E+00  0,34652180298E+01 

TIME,  RES  =  2.4957785237078558E-03  -4, 5373859981 767684E-09 

-2.5305657902485734E-08  6. 16487826066158B2E-10 

TIME,  RES  =  2.9915570474157117E-03  -4.5379407419277040E-09 

-2.5364198408261984E-08  6.9115368810102051E-10 

TIME,  RES  =  3, 48733557 11235675E-03  -4.5387530643592466E-09 

-2 . 5427572269975940E-08  7 , 566B833005027025E- 1 0 

TIME,  RES  =  3,9831140948314234E-03  -4.539B215013647825E-09 

-2.549609501301 1200E-08  8.13807403410304B9E-10 

ITERATION  2 

STATE  CORRECTIONS 

0.52198591303E-08  0.24406562612E-08  0.22459833969E-08  0.20028238320E-08 
-0 . 40427085434E-08  0 . 34472377184E-07-0 . 84575884981E-04  0 . 75924844793E-03 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH*. 

-0 , 13261 130908E+00-0 .57696953519E+00  0 , 80592828227E+00-0 . 10225944088E-02 
-0.44491365392E-02  0.62768336930E-02  0.37381698976E+00  0.346597727B3E+01 


LAST  PASS  RESIDUALS 


TIME,  RES  =  2.4957785237078558E-03  2.0303203562832550E-14 

4.44089209850062&2E-16  1 ,5&7121432&218319E-12 

TIME,  RES  =  2.9915570474157117E-03  8.3044&82241961709E-14 

-2.2648549702353193E-14  A.0433134191351101E-12 
TIME,  RES  =  3. 487335571 1235A75E-03  1.8791218581 171 165E-13 

-6.1950444774083735E-14  1 .3519&662892&3377E-11 

TIME,  RES  =  3.9831140948314234E-03  3.3503408380930466E-13 

-1,191 2 A93054227930E- 1 3  2 . 4005847&5693825 1 E- 1 1 


CONVERGENCE  ACHIEVED. 

IN  NOMINIA  GAUSSIAN  TRAJECTORUM  REFERENTIA 
DECLARIUH  EST  ESTIMATIA 


COVARIANCE  MATRIX  AT  EPOCH  IS*. 

0 .9952970E-10  0 . 434A840E-09-0 . 2433596E-09-0 . 1774353E-07-0 . 7721903E-07 
0 . 105A279E-06-0 . 1 163509E-03  0 . 1017210E-02 

0.4346840E-09  0.2151919E-08-0.1429787E-08-0.7749480E-07-0.3398025E-0A 
0 .4650144E-06-0 .5240531E-03  0 . 4589980E-02 

-0.2433596E-09-0.1429787E-08  0.3188217E-08  0.105&544E-0&  0.463433AE-06 
-0 , AA79942E-06  0 . 73A6104E-03-0 . 6451023E-02 

-0.1774353E-07-0,7749480E-07  0.105A544E-06  0.&492580E-05  0.2825354E-04 
-0.3991971E-04  0.5108447E-01-0.4478712E+00 


-0.7721903E-07-0.3398025E-06  0 . 463433&E-0&  0.2825354E-04  0.1229982E-03 
-0 . 1737858E-03  0 . 22259&4E+00-0 . 1951713E+01 


0.1056279E-06  0,4A50144E-06-0.6679942E-06-0,3991971E-04-0,1737858E-03 
0,2461941E-03-0,3148609E+00  0 .27ACA45F+01. 

-0,1163509E-03-0.5240531E-03  0.736A104E-03  0,5108447E-0l  0.2225964E+00 
-0 , 3148&09E+00  0 . 4758258E+03-0 .4185478E+04 

0 . 1017210E-02  0 . 4589980E-02-0 .6451023E-02-0 . 4478712E+00-0 . 1951713E+01 
0 ,2760645E+01-0 . 4185478E+04  0 .3681900E+05 


BEGIN  NEXT  BAYES  LOOP 
FIRST  PASS  residuals; 

TIME,  RES  =  2.7284704709100647E-02  5.8865527036155996E-11 

-2.1008750294981837E-12  4.1108263182376703E-09 

TIME,  RES  =  2.7780483232808503E-02  6.1308354226685&80E-11 

-3 . 4A500(i0598551 1 36E- 13  4 . 2788280505551 279E-09 

TIME,  RES  =  2,8276261756516359E-02  6.3805991740162327E-11 

1.6535661728767082E-12  4.4504220621244261E-09 

TIME,  RES  =  2. 877204028022421 5E-02  6.6358824685197A04E-11 


3 .8953285041998242E- 12  4 . 6256138329370255E-09 


SIGMA  IN-TRACK  =  0.1 6666743 17104E-04 


ITERATION  1 
STATE  CORRECTIONS 

-0 . 876783986 lOE- 10-0 . 38 1 48 1 29523E-09  0 . 53389609320E-09-0 . 73890898778E-08 
-0.32152330156E-07  0.44096371176E-07  0.17303193378E-07  0.52380045297E-05 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH! 

-0.13264929664E+00-0.57713481269E+00  0.80616992861E+00-0.20694915254E-02 
-0.90040100787E-02  0.13751501021E-01  0.37381700706E+00  0.34659825163E+01 


LAST  PASS  RESIDUALS! 

TIME,  RES  =  2.7284704709100647E-02  -1.4918621893400541E-16 

-1.1102230246251565E-16  5.887824949B128810E-14 

TIME,  RES  =  2.7780483232808503E-02  3.6429192995512949E-16 

-6,3282712403633923E-15  8.7695475881055529E-14 

TIME,  RES  =  2.8276261756516359E-02  1 .2594092435591620E-15 

-1.1 102230246251565E-15  1 .4577922202718696E-13 

TIME,  RES  =  2.8772040280224215E-02  2.5708601913976281E-15 

-4.996003610B132044E-15  2.2435352187155644E-13 

CONVERGENCE  ACHIEVED. 

IN  NOMINIA  GAUSSIAM  TRAJECTORUM  REFERENTIA 
DECLARIUM  EST  ESTIMATIA 


COVARIANCE  MATRIX  AT  EPOCH  IS! 

0 . 1021808E-09  0 . 4459627E-09-0 . 1873908E-09-0, 1601955E-07-0 . 6973250E-07 
0 . 9609681 E-07-0 . 8787998E-04  0 . 69901 43E-03 

0 , 4459627E-09  0 .2278202E-08-0 . 1294304E-08-0 . 6978741E-07-0 . 31 18651E-06 
0,4301474E-06-0.3882012E-03  0.3093026E-02 


-0.1873908E-09-0.1294304E-08  0.3486790E-08  0.9547385E-07  0.4270635E-06 
-0 . 6994367E-06  0 .5916256E-03-0 . 4712534E-02 

-0.1601955E-07-0.6978741E-07  0.9547385E-07  0.5549S36E-05  0.2414B16E-04 
-0 . 3696024E-04  0 . 3826282E-0 1-0 . 3052991E+00 

-0.6973250E-07-0.3118651E-06  0.4270635E-06  0.2414816E-04  0. 1053920E-03 
-0. 1612732E-03  0. 1667023E+00-0 . 1330314E+01 

0 ,9609681E-07  0 .4301474E-06-0 .6994367E-06-0 .3696024E-04-0 . 1612732E-03 
0 . 251 3625E-03-0 . 2576357E+00  0 . 2055B44E+01 

-0.87B7998E-04-0.3882012E-03  0.5916256E-03  0.3826282E-01  0.1667023E+00 
-0 . 2576357E+00  0 . 31 26587E+03-0 . 2503272E+04 
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0.6990143E-03  0.3093026E-02-0.4712534E-02-0.3052991E+00-0,1330314E+01 
0 .2055844E+01-0 , 2503272E+04  0 . 2004372E+05 


BEGIN  NEXT  BAYES  LOOP 

FIRST  PASS  residuals: 

TIME,  RES  =  5.2073630894493458E-02  4.9264065049570149E-13 

- 1 . 756039758049A101E- 12  3 . 3055A45026758285E- 1 1 

TIME,  RES  =  5.2569409418201314E-02  5.1326998207201768E-13 

-1.8227641618295820E-12  3.4413484215067847E-11 

TIME,  RES  =  5.3065187941909170E-02  5. 344509557 1369450E- 13 

- 1 . 8967050 1 526961 74E- 12  3 . 5808 1 30766090684E- 1 1 

TIME,  RES  =  5. 356096646561 7026E-02  5.5613499916340459E-13 

- 1 . 9659829320062272E- 12  3 . 7227602944778226E- 1 1 

SIGMA  IN-TRACK  =  0. 16681 12660909E-04 


ITERATION  1 
STATE  CORRECTIONS 

-0 , 65500222064E-1 2-0 . 28503051 805E-1 1  0 . 44572870523E- 1 1 -0 , 5481 0502834E-1 0 
-0 .24036247152E-09  0 . 37429090367E-09-0. 20000152684E-09  0 . 37782548127E-07 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH: 
-0.13271389418E+00-0,57741586575E+00  0.80664307130E+00-0.31096134892E-02 
-0.13529406067E-01  0.25228387479E-01  0,37381700686E+00  0.34659825541E+01 


LAST  PASS  residuals: 

TIME,  RES  =  5.2073630894493458E-02  -1.7000290064572710E-16 
-3 , 3306690738754696E- 16  3 . 0765320846448674E- 1 4 
TIME,  RES  =  5,2569409418201314E-02  -2.0469737016526324E-16 
2 . 1094237467877974E-15  2 . 4917568008930857E- 14 
TIME,  RES  =  5.3065187941909170E-02  -1 .5959455978986625E-16 
-1,5543122344752192E-15  2. 657943309891 6638E- 14 
TIME,  RES  =  5.3560966465617026E-02  -9.7144514654701197E-17 
-1.1 102230246251565E-16  2 .3927040904148100E-14 

CONVERGENCE  ACHIEVED. 

IN  NOMINIA  GAUSSIAM  TRAJECTORUM  REFERENTIA 
DECLARIUM  EST  ESTIMATIA 


COVARIANCE  MATRIX  AT  EPOCH  IS: 

0 . 9582257E- 1 0  0 . 4 1 70304E-09-0 . 1 1 94 127E-09-0 . 1 225665E-07-0 . 53325 1 9E-07 
0 . 7963670E-07-0 . 5843050E-04  0 . 4 184784E-03 

0 .4170304E-09  0 . 2216048E-08-0 . 1091350E-08-0 . 5336797E-07-0 . 2459154E-06 


0 .36&4448E-06-0 . 2559888E-03  0 . 1836552E-02 

-0.1194127E-09-0.1091350E-08  0.378753&E-08  0.7888053E-07  0.3627788E-06 
-0 . 7576789E-06  0 . 478702 1 E-03-0 . 3432403E-02 

-0.1225665E-07-0.5336797E-07  0.7888053E-07  0.3887359E-05  0. 1691402E-04 
-0.3133359E-04  0.2519131E-01-0.1810560E+00 

-0.5332519E-07-0.2459154E-06  0.3&27788E-06  0.1691402E-04  0.74295HE-04 
-0.1373414E-03  0.1096935E+00-0.7885532E+00 

0 .79&3670E-07  0 . 3664448E-0&-0 .7576789E-06-0 .3133359E-04-0 , 1373414E-03 
0 .26&8306E-03-0 . 2095178E+00  0 . 1505928E+01 

-0.5843050E-04-0.2559888E-03  0.4787021E-03  0.2519131E-01  0. 1096935E+00 
-0.2095178E+00  0.1959883E+03-0.1413871E+04 

0.4184784E-03  0.183A552E-02-0.3432403E-02-0,18105&0E+00-0,7885532E+00 
0 , 1 505928E+0 1-0 . 1 4 1387 1 E+04  0 . 102006&E+05 


BEGIN  NEXT  BAYES  LOOP 

FIRST  PASS  residuals; 

TINE,  RES  =  7.&862557079886247E-02  4.4061976289810900E-15 

-5 . 384581 6694320092E- 14  3 . 1 7&504 1 985&54108E- 1 3 

TIME,  RES  *  7.7358335A03594102E-02  4.607425552194399&E-15 

-5.1847415249994810E-14  3.3374171481970194E-13 

TIME,  RES  =  7.7854114127301957E-02  4.7739590058881731E-15 

-6.0840221749458578E-14  3.4938718584953&76E-13 

TIME,  RES  =  7.8349892651009813E-02  4.8919202022545960E-15 

-6 . 3393734706096438E- 1 4  3 . 66266045270791 1 OE- 1 3 

SIGMA  IN-TRACK  =  0. 166983389 1639E-04 


ITERATION  1 
STATE  CORRECTIONS 

-0.46465859151E-14-0,20378244274E-13  0.42944297481E-13-0,36379065245E-12 
-0.28772496149E-11  0.52258055059E-11  0.28226532239E-10  0.13761676262E-09 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH; 

-0.13280006712E+00-0.57779078973E+00  0.80746713135E+00-0.37386480452E-02 
-0,16266229783E-01  0,42310351301E-01  0»373817006B9E+00  0.34659825542E+01 


LAST  PASS  residuals; 

TIME,  RES  =  7.6862557079886247E-02  -1 .457167719B205180E-16 

-2.2204460492503131E-16  2.0785456689154103E-14 

TIME,  RES  =  7. 7358335603594 102E-02  -9.3675067702747583E-17 


4 . 1 07825191 1 130792E- 15  1.8901 546994243290E- 1 4 

TIME,  RES  =  7.7854114127301957E-02  -7.2858385991025898E-17 
-2.5535129566378&00E-15  1 .6233542288190961E-14 

TIME,  RES  =  7.8349892651009813E-02  -1 .0755285551056204E-1A 
-2.6&45352591003757E-15  1 .4547391069541504E-14 

CONVERGENCE  ACHIEVED. 

IN  NOMINIA  GAUSSIAM  TRAJECTORUM  REFERENTIA 
DECLARIUM  EST  ESTIMATIA 


COVARIANCE  MATRIX  AT  EPOCH  ISt 

0.871 70 17E-10  0. 3751 040E-09-0 . 3326&89E- 10-0.81 05970E-08-0 . 3507808E-07 
0 .5617388E-07-0 . 3302409E-04  0 . 210331&E-03 

0 . 3751040E-09  0 . 2088885E-08-0 .811 7545E-09-0 . 351 42&0E-07-0 . 1 71 3959E-06 
0 .2724029E-06-0 . 1439905E-03  0 .91897&0E-03 


-0.332&A89E-10-0.8117545E-09  0.4034138E-08  0.5557304E-07  0.2&89732E-06 
-0 . 81 19042E-0A  0 . 3781973E-03-0 . 241 130&E-02 


-0.8105970E-08-0.35142&OE-07  0.5557304E-07  0.2134409E-05  0.9275&36E-05 
-0. 2299924E-04  0 . 1405391E-01-0 . 8987830E-01 


-0.3507808E-07-0.1713959E-0&  0.2689732E-0A  0.9275636E-05  0.4144713E-04 
-0 . 1017038E-03  0 . A1 16449E-01-0 . 3912732E+00 


0 .5&17388E-07  0 . 2724029E-06-0 .81 19042E-06-0 . 2299924E-04-0 . 1017038E-03 
0.2816984E-03-0.1652431E+00  0.1056772E+01 

-0.3302409E-04-0.1439905E-03  0.3781973E-03  0. 1405391E-01  0.6116449E-01 
-0.1652431E+00  0.11 60075E+03-0 . 7449684E+03 

0 . 2103316E-03  0 .9189760E-03-0 . 241 1306E-02-0 . 8987830E-01-0 . 3912732E+00 
0 . 1056772E+01-0 . 7449&84E+03  0 . 4784510E+04 


BEGIN  NEXT  BAYES  LOOP 
FIRST  PASS  residuals: 

TIME,  RES  =  0.1016514832652790  -2.7755575615628914E-16 

-5.6621374255882984E-15  1 ,6615181452905858E-14 

TIME,  RES  =  0.1021472617889869  -1.5612511283791264E-16 

-4.9960036108132044E-15  2.3573157315048832E-14 

TIME,  RES  =  0.1026430403126947  -3.4000580129145419E-16 

-6.8833827526759706E-15  1 .9579823873350222E-14 

TIME,  RES  =  0.1031388188364026  -3.1225022567582528E-16 

-7.9936057773011271E-15  2.3337234922315986E-14 

SIGMA  IN-TRACK  =  0.1672010053966E-04 


ITERATION  1 


STATE  CORRECTIONS 

0 , 1 8790925274E- 15  0 . 69812975344E-15-0 . 30507751996E- 15  0 . 63520937713E-13 
-0.71274434228E-12  0.1306935414<iE-ll-0.30967718809E-ll  0.68009983775E-10 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH t 

-0 . 1 3289245339E+00-0 . 57819274689E+00  0 . 80879758045E+00-0 . 35486447744E-02 
-0,15439557466E-01  0. 66263 123332E-01  0.37381700689E+00  0.34659825543E+01 


LAST  PASS  residuals: 

TIME,  RES  =  0.1016514832652790  -1 .4918621893400541E-16 

-2.6645352591003757E-15  1 .6184970030863610E-14 

TIME,  RES  =  0.1021472617889869  6.9388939039072284E-18 

-1 .2212453270876722E-15  1 .8735013540549517E-14 

TIME,  RES  =  0.1026430403126947  -1 .4224732503009818E-16 

-2.4424906541753444E-15  1 .0231399061311208E-14 

TIME,  RES  =  0.1031388188364026  -7.9797279894933126E-17 

-2 . 8865798640254070E- 15  9 . 5323055004925550E- 15 

CONVERGENCE  ACHIEVED. 

IN  NOMINIA  GAUSSIAM  TRAJECTORUM  REFERENTIA 
DECLARIUM  EST  ESTIMATIA 


COVARIANCE  MATRIX  AT  EPOCH  ISt 

0 . 8240535E- 10  0. 3440370E-09  0 . 6705432E-1 0-0 . 5233755E-08-0 . 2206845E-07 
0 .2867981E-07-0 . 1477205E-04  0 .8234582E-04 

0 ,3440370E-09  0 . 2001734E-08-0 .4910335E-09-0 . 2214222E-07-0 . 1 188648E-06 
0 . 1617684E-06-0 . 6408704E-04  0 .3583440E-03 

0.6705432E-10-0.4910335E-09  0.4147672E-08  0.2841356E-07  0. 1589995E-06 
-0 . 8267293E-06  0 . 2807439E-03-0 . 1566964E-02 

-0,5233755E-08-0.2214222E-07  0.2841356E-07  0.8951293E-06  0.3846952E-05 
-0.1319633E-04  0.6148244E-02-0.3444676E-01 

-0.2206845E-07-0.1188648E-06  0.1589995E-06  0.3846952E-05  0. 1817094E-04 
-0 . 5976963E-04  0 . 2673836E-01-0 . 1498773E+00 

0 .2867981E-07  0 . 1617684E-06-0 .8267293E-06-0 . 1319633E-04-0 . 5976963E-04 
0 .2818795E-03-0 . 1218494E+00  0 .6826465E+00 

-0.1477205E-04-0.6408704E-04  0.2807439E-03  0.6148244E-02  0.2673836E-01 
-0.121B494E+00  0.6328257E+02-0.3562099E+03 


0.8234582E-04  0.3583440E-03-0.1566964E-02-0.3444676E-01-0.1498773E+00 
0 , 6826465E+00-0 . 3562099E+03  0 . 2005346E+04 


SIGMrt  IN- TRACK  =  0 . 1683198864345E-04 


LAST  GOOD  VALUES  FOR  THE  MAIN  STATE  VECTOR 

-0.13273855498E+00  -0.57752316076E+00  0.82341630055E+00  0.10999752541E-01 

0.47858075956E-01  0.262493A4632E+00  0.37381700695E+00  0.34659825541E+01 

NONLINEAR  LS  STAGING  ESTIMATOR 

INITIAL  GUESS  IS  : 

VE*M  =  0.98000000000E+00  TSTAGE  =  0,20450000000E+00 

Q  INVERSE,  A  1  X  1  MATRIX,  IS  : 

0.3529629&671E+10 
FIRST  PASS  RESIDUALS  : 

RESIDUAL  =  -0.60667594581E-06 

RESIDUAL  =  -0.92077802844E-OA 

RESIDUAL  =  -0.13031513361E-05 

f'ESIIilJAL  =  -0.17642025303E-05 

RESIDUAL  =  -0.23090783295E-05 

P  INVERSE  MATRIX  IS  : 

■).140C'282?‘122E+04  0 . 49312284707E+06 

o . 4P31 2284707Ev06  0 . 1 8685772084E+09 

P  MATRIX  13  : 

0 . 101 09413740E-01  -0 . 26679030780E-04 

-0.2A6790307SOE-04  0 . 75758387460E-07 

ITERATION  1 

STATE  CORRECTIONS 
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-0 . 49716864 1 43E+00  0 . 57629874606E-03 

CURRENT  STAGING  STATE  VECTOR 

VE*M  =  0.48283135857E+00  TSTAGE  =  0 


RESIDUAL  =  0,17853352765E-06 
RESIDUAL  =  -0,10514035089E-05 
RESIDUAL  =  -0.13884175885E-05 
RESIDUAL  =  -0.24531349446E-05 


RESIDUAL  =  -0.28728138233E-05 
P  INVERSE  MATRIX  IS  I 


0.12180637603E+04 

0.52242272939E+06 

P  MATRIX  IS  t 


0.10654070136E-01 

-0.22926523022E-04 


ITERATION  2 

STATE  CORRECTIONS 
0.47353621114E-02 


0.52242272939E+06 

0.24277246028E+09 


-0.22926523022E-04 

0,53454731717E-07 


-0.89575794963E-04 


CURRENT  STAGING  STATE  VECTOR 

VE*M  =  0.48756672068E+00  TSTAGE  =  0 


RESIDUAL  =  0,88336356369E-07 

RESIDUAL  =  -0.96890627918E-06 

RESIDUAL  =  -0,11355161182E-05 

RESIDUAL  =  -0.20321 193943E-05 

RESIDUAL  =  -0,22859743536E-05 

P  INVERSE  MATRIX  IS  : 

0 . 1 2452194472E+04  0 , 5301 4744828E+06 
0,53014744828E+06  0.24457180922E+09 

P  MATRIX  IS  : 

0.10412071273E-01  -0.22569784450E-04 


20507629875E+00 


20498672295E+00 
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-0 . 22569784450E-04  0 . 5301 2298006E-07 


ITERATION  3 
STATE  CORRECTIONS 

0 .372A6855314E-03  -0  *  80978025335E-06 

CURRENT  STAGING  STATE  VECTOR 

VE«M  =  0,48793938923E+00  TSTAGE  =  0.20498591317E+00 


LAST  PASS  RESIDUALS  : 


RESIDUAL  =  0.87657575102E-07 

RESIDUAL  =  -0.968033435<i7E-06 

RESIDUAL  =  -0.11331934210E-05 

RESIDUAL  =  -0,20284486145E-05 

RESIDUAL  =  -0.22810572&22E-05 

CONVERGENCE  HAS  BEEN  ACHEIVED 
COVARIENCE  MATRIX  I 

0,10412071273E-01  -0.22569784450E-04 

-0 , 22569784450E-04  0 . 53012298006E-07 


BEGIN  ESTIMATION  OF  THE  NEXT  STAGE 
STAGING  OCCURED  AT  t  165.3854  SECONDS 


AT  THE  START  OF  THE  NEXT  STAGE  THE 
COVARIANCE  MATRIX  AT  EPOCH  ISl 

0.7219619E-10  0.2292700E-09  0.2974801E-09-0,2272561E-08-0,4619524E-08 
0 .3999174E-07-0 .3954023E-05  0 . 1285A03E-04 

0.2292700E-09  0. 1341629E-08  0.4581231E-09-0.4564984E-08-0.4043245E-07 
0 .2292172E-06-0 . 1708788E-04  0 .5560764E-04 

0.2974801E-09  0.4581231E-09  0.4375583E-08  0.4098511E-07  0,2294855E-06 
0.1374155E-05-0,1090551E-03  0.3546261E-03 

-0,2272561E-08-0.4564984E-08  0. 409851 lE-07  0. 1393559E-05  0.5387628E-05 
0.2713599E-04-0.1887962E-02  0.6122962E-02 


-0.4619524E-08-0,4043245E-07  0,2294855E-06  0.5387628E-05  0.2560498E-04 
0,111 7689E-03-0 . 8227548E-02  0 . 2667774E-01 
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0.3999174E-07  0.2292172E-06  0.1374155E-05  0.2713599E-04  0. 1117689E-03 
0 .7318132E-03-0 .5286334E-01  0 . 1712357E400 

-0 . 3954023E-05-0 . 1708788E-04-0 . 1090551E-03-0 . 1887962E-02-0 . 8227548E-02 
-0.5286334E-01  0 .7807597E+01-0. 1266701E+02 

0.1285603E-04  0.5560764E-04  0.3546261E-03  0.61229A2E-02  0.2667774E-01 
0 . 1712357E+00-0 . 126A701E+02  0 .4767188E+02 


INITIAL  STATE  VECTOR  IS: 

-0.13268644568E+00-0.57729644194E+00  0.82462090470E+00  0. 12371639365E-01 
0.53826925127E-01  0.27759580461E+00  0»37381700695E+00  0. 13052894335E+01 

FIRST  PASS  residuals: 

TIME,  RES  =  0.2052691947202211  -1. 066800688551 1394E-07 

2.7666640292078881E-06  -2.5221229591175249E-06 
TIME,  RES  =  0.2057649732439289  -6.6257463609414868E-08 

1 .7092021478148922E-06  -1 .5586033374444860E-06 
TIME,  RES  =  0.2062607517676368  -1.4542719782920099E-07 

3.7284482460320234E-06  -3,4051571719666838E-06 
TIME,  RES  =  0,2067565302913446  -1 ,1518067354748807E-07 

2.9312333728048756E-06  -2.6859194964224623E-06 

ITERATION  1 

STATE  CORRECTIONS 

0 .27947285933E-05  0 .51659989201E-05  0 . 12463054502E-04-0 . 22407685694E-03 
-0,48035112741E-03-0.17931369721E-02-0.48885313317E+00  0.24325465391E+01 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH: 

-0,13268365095E+00-0.57729127594E+00  0.82463336776E+00  0.12147562508E-01 
0,53346574000E-01  0.27580266764E+00-0.11503612622E+00  0.37378359726E+01 

TIME,  RES  =  0,2052691947202211  -3,9398841313389998E-07 

6,8081716283918681E-05  -3.8993217985426229E-05 
TIME,  RES  =  0,2057649732439289  -2.1515823409382073E-07 

6.1286736198762348E-05  -3.3391813777461561E-05 
TIME,  RES  =  0.2062607517676368  -1.1626135429376738E-07 

5. 660269553631 1920E-05  -2.9724568292323209E-05 
TIME,  RES  =  0.2067565302913446  1 .3226517794201476E-07 

4,8134941661 1 15427E-05  -2 . 2616540661754342E-05 

ITERATION  2 

STATE  CORRECTIONS 

0 .20213936525E-04  0 , 38004641141E-04  0 . 63198943909E-04-0 . 14703671 177E-02 
-0 . 23317662547E-02-0 . 48829433057E-02  0 , 27525132797E+00-0 . 20838244703E+01 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH ’, 


-0. 13266343702E+00-0 . 57725327130E+00  0 . 82469656670E+00  0 . 10677195390E-01 
0.51014807745E-01  0.27091972433E+00  0.16021520176E+00  0. 165401 15023E+01 

TIME,  RES  =  0.2052691947202211  1.309589643B455878E-06 

4.7161928405947684E-04  -1 .9525755752451571E-04 
TIME,  RES  =  0.2057649732439289  1 .31681 11263200943E-06 

4.5129367802287934E-04  -1 .8332666373B48067E-04 
TIME,  RES  =  0.2062607517676368  1.2191644338799268E-06 

4.3381358600924624E-04  -1 .73997652321 06637E-04 
TIME,  RES  =  0.2067565302913446  1.2457809634505712E-06 

4.1328569900977996E-04  -1 .6189509109424348E-04 

ITERATION  3 

STATE  CORRECTIONS 

-0.17459945581E-04-0.33881940895E-04-0.48065121542E-04  0.13185494741E-02 
0.20905297535E-02  0.36778866682E-02-0.91053293263E-02  0.36026970955E+01 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH: 

-0.13268089696E+00-0.57728715324E+00  0.82464850158E+00  0.11995744865E-01 
0.53105337499E-01  0. 27459761 lOOE+00  0.15110987243E+00  0.52567085978E+01 

TIME,  RES  =  0.2052691947202211  -1.0996823459653859E-06 

1 .4042464282282285E-04  -9.3573461807766188E-05 
TIME,  RES  =  0.2057649732439289  -9.5380379165621587E-07 

1 .3285719729894 1 19E-04  -8 . 7349612804029980E-05 
TIME,  RES  =  0.2062607517676368  -9.3802674196868940E-07 

1 .2869421153727245E-04  -8.4233738722306164E-05 
TIME,  RES  =  0.2067565302913446  -8.235B948817404243E-07 

1 .2204451 138764227E-04  -7.8851014942505357E-05 

ITERATION  4 

STATE  CORRECTIONS 

-0 . 55228533587E-05-0 . 91595367698E-05-0 .28322576164E-04  0 . 34490417081E-03 
0 , 610701 90922E-03  0 . 24261349755E-02  0 . 9961 4878725E-0 1-0 . 1 1 236709989E+01 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH*. 

-0.13268641981E+00-0.57729631277E+00  0.82462017900E+00  0.12340649035E-01 
0.53716039408E-01  0.27702374597E+00  0.25072475116E+00  0.41330375989E+01 

TIME,  RES  =  0.2052691947202211  5.9345062804888604E-08 

-3. 95894500515581 17E-08  2 . 1755918473844544E-06 
TIME,  RES  =  0.2057649732439289  1.1223209894425934E-07 

- 1 . 4702245543229964E-06  3 . 4774821489025028E-06 
TIME,  RES  =  0.2062607517676368  2.3137472028589290E-08 

7.5657393683314922E-07  1 .4428978898560442E-06 

TIME,  RES  =  0.2067565302913446  2.0685401072584320E-08 

7.4974219210766080E-07  1 ,4471472687358497E-06 

ITERATION  5 


STATE  CORRECTIONS 


0 . 12568873931E-06  0 . 3493001 1033E-06  0 » 1 1051&34702E-05-0 . 10722929414E-04 
-0,48360988195E-04-0.20456901780E-03  0.61990752066E-01-0.67310049094E+00 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH t 

-0.13268629413E+00-0.5772959A347E+00  0.82462128417E+00  0,12329926106E-01 
0.53667678420E-01  0.27681917&96E+00  0.31271550322E+00  0,34599371080E+01 

TIME,  RES  =  0.2052691947202211  -5.9440643084690548E-08 

5.0653607587269889E-06  -1 .3858576813672403E-06 
TIME,  RES  =  0.2057649732439289  6.9109882677720336E-09 

3.2425434746130577E-06  2.3914259472798596E-07 

TIME,  RES  =  0.2062607517676368  -7.0431791444197644E-08 

5.1250496658772349E-06  -1 .5158005831766852E-06 
TIME,  RES  =  0.2067565302913446  -6.2858944677862683E-08 

4.8215450664246262E-06  -1 .2750228422965396E-06 

ITERATION  6 

STATE  CORRECTIONS 

0.71 627086334E-07  0 . 98337463637E-07  0 . 4801990821 1 E-06-0 . 62856487820E-05 
-0.18654083950E-04-0.86701751338E-04  0.41876536390E-01-0.44912189366E+00 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH! 

-0.13268622250E+00-0.57729586514E+00  0.82462176437E+00  0.12323640457E-01 
0.53649024336E-01  0.27673247521E+00  0.35459203961E+00  0.30108152143E+01 

TIME,  RES  =  0.2052691947202211  -8.5885428307425071E-08 

7 .05459951 1668B687E-06  -3.11 19083535280064E-06 
TIME,  RES  *  0.2057649732439289  -1 .2761536424821252E-08 

5.0152662687263927E-06  -1 .2980526630066054E-06 
TIME,  RES  *  0.2062607517676368  -8.2651255142035529E-08 

6.6657929627123025E-06  -2.8501384153564215E-06 
TIME,  RES  =  0.2067565302913446  -6.6925294705394434E-08 

6.11 4561410419661 lE-06  -2 . 3922799560646647E-06 

ITERATION  7 

STATE  CORRECTIONS 

-0.55958817895E-07-0.11205552011E-06-0.14511810623E-06  0.31615365692E-05 
0 . 12608074536E-05-0 .99131061084E-05  0 .26784026054E-01-0 . 27761919539E+00 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH! 

-0.13268627846E+00-0.57729597719E+00  0.82462161925E+00  0. 12326801994E-01 
0.53650285143E-01  0. 276722562 lOE+00  0.3B137606567E+00  0.27331960189E401 

TIME,  RES  =  0.2052691947202211  -9.2251456928343911E-08 

5 . 9439568005359433E-06  -2 . 7864570481668472E-06 
TIME,  RES  =  0.2057649732439289  -1.5145693154500206E-08 

3.8531791556328798E-06  -9. 11 56972474961 458E-07 
TIME,  RES  =  0.2062607517676368  -7.9985648042402158E-08 

5.4254391060881701E-06  -2.3782884488108809E-06 
TIME,  RES  =  0.2067565302913446  -5.8120182999665815E-08 

4.7689174730303208E-06  -1 .8106078855120939E-06 
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ITERATION  8 


STATE  CORRECTIONS 

-0 . 46740635328E-07-0 . 88975497940E-07-0 . 1 A009519675E-0&  0 . 30069009510E-05 
0 . 33362773978E-05  0 . 475288804 1 8E-05  0 . 1 2833686088E-01 -0 ♦ 1 4736778570E+00 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH: 

-0,13268A32520E+00-0.57729A0A(S17E+00  0.824A2145915E+00  0.12329808895E-01 
0.53&53621421E-01  0. 27672731 499E+00  0.39420975175E+00  0.25858282332E+01 

TIME,  RES  =  0,2052A91947202211  -9.2568815009130834E-08 

4 .9309574480238538E-06  -2 . 3423131804570577E-06 
TIME,  RES  =  0.2057649732439289  -1.3169310766891762E-08 

2.8216741309039506E-06  -4.3980834B89224482E-07 
TIME,  RES  =  0.2062607517676368  -7.4756849342827447E-08 

4 . 35 1 0427293336207E-06  - 1 . 8567887637956559E-06 
TIME,  RES  =  0.2067565302913446  -4.8662902121104912E-08 

3.6271241935503795E-06  -1 .2171972008565273E-06 

ITERATION  9 

STATE  CORRECTIONS 

-0.21814542917E-07-0.41431189138E-07-0.77328410591E-07  0.146B2438772E-05 
0.18168483112E-05  0.36187938125E-05  0.43035319706E-02-0.6719B725485E-01 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH! 

-0.13268634701E+00-0.57729610760E+00  0.82462138182E+00  0.12331277139E-01 
0.53655438269E-01  0.27673093378E+00  0. 39851 328372E+00  0.25186295078E+01 

TIME,  RES  =  0.2052691947202211  -9.2283821154226509E-08 

4.4501171104771586E-06  -2.1229694431953343E-06 
TIME,  RES  =  0.2057649732439289  -1 .162720451 1699407E-08 

2.3274525933203449E-06  -2.0331170162257283E-07 
TIME,  RES  =  0.2062607517676368  -7. 1307596889724767E-08 

3,826B837719845905E-06  -1 .5B81245615801927E-06 
TIME,  RES  =  0.2067565302913446  -4.2645423869308585E-08 

3 ,0564096480389935E-06  -9 . 013331533341 1346E-07 

ITERATION  10 

STATE  CORRECTIONS 

-0,65324430519E-08-0.12885990430E-07-0.21565212354E-07  0.45648874025E-06 
0.53998262219E-06  0.97032282081E-06  0.10791526940E-02-0.27157126207E-01 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH! 

-0.13268635355E+00-0.57729612049E+00  0.82462136026E+00  0. 12331733627E-01 
0.53655978252E-01  0,27673190410E+00  0.39959243642E+00  0,24914723815E+01 


LAST  PASS  RESIDUALS! 

TIME,  RES  =  0.2052691947202211  -9.2311275984302554E-08 


4.3073794059322879E-06  -2.0644980302706416E-06 
TIME,  RES  =  0.2057649732439289  -1 .1049917609390336E-08 

2 . 1 750744690907098E-06  - 1 . 3449998229270524E-07 
TIME,  RES  =  0.2062607517676368  -6.9787447175284623E-08 

3.65626763865201 lOE-06  -1 .5011770738001737E-06 
TIME,  RES  =  0.2067565302913446  -3. 9838729780361 51 5E-08 

2,8589302542014750E-06  -7.8844934725097026E-07 

CONVERGENCE  ACHIEVED. 

IN  NOMINIA  GAUSSIAM  TRAJECTORUM  REFERENTIA 
DECLARIUM  EST  ESTIMATIA 


COVARIANCE  MATRIX  AT  EPOCH  IS: 

0.2156279E-10  0.5614992E-10  0.6614793E-10-0.3907751E-09-0. 1048720E-08 
-0.21 06966E-08  0 . 8397057E-07-0 . 2854256E-06 

0.5614992E-10  0.3144568E-09  0.2744374E-10-0.9228647E-09-0.4783594E-08 
-0 . 2693 1 78E-08  0.1 856897E-06-0 . 6369346E-06 


0.6614793E-10  0.2744374E-10  0.4326082E-09-0.1551008E-08-0.2667617E-08 
-0.1 553572E-07  0.8721 276E-06-0 . 3032271E-05 

-0 . 390775 1 E-09-0 . 9228647E-09-0 . 1 55X008E-08  0 . 1 352736E-07  0 . 31 95293E-07 
0.8530684E-07-0.5101951E-05  0.1784111E-04 


-0 . 1048720E-08-0 . 4783594E-08-0 .2667617E-08  0 . 3195293E-07  0 . 1372941E-06 
0 .2036460E-06-0 . 1837260E-04  0 . 6495248E-04 

-0 . 2 106966E-08-0 . 2693178E-08-0 . 1553572E-07  0 . 8530684E-07  0 . 2036460E-06 
0.9744056E-06-0.8370782E-04  0.2972636E-03 

0 ,8397057E-07  0 . 1856897E-06  0.8721276E-06-0 .5101 951E-05-0 . 1B37260E-04 
-0 . B370782E-04  0 . 1053589E-01-0 .3802754E-01 

-0 . 2854256E-06-0 . 6369346E-06-0 . 3032271E-05  0 . 1784 1 1 lE-04  0 . 6495248E-04 
0 .2972636E-03-0 . 3802754E-01  0 . 1373587E+00 


BEGIN  NEXT  BAYES  LOOP 
FIRST  PASS  RESIDUALS! 

TIME,  RES  =  0.3044248994617925  -1.0570388328901698E-05 

1.3911211906703080E-04  -1 .0599243159586762E-04 
TIME,  RES  =  0.3049206779855004  -1.0707369779264925E-05 

1 .4052377534878868E-04  -1 .0698789522938131E-04 
TIME,  RES  =  0.3054164565092082  -1.0845476437117835E-05 

1 .4194169065884221E-04  -1 .0798661B69996021E-04 
TIME,  RES  =  0.3059122350329161  -1. 09847 12339595637E-05 

1 .4336584008778352E-04  -1 .0898B57970778955E-04 


SIGMA  IN-TRACK  =  0.1694476316555E-04 


ITERATION  1 


STATE  CORRECTIONS 

-0, 19247846794E-05-0 . 8595&084254E-05-0 . 3124705471&E-04-0 , 45&37655153E-04 
-0 . 20 1 4043799 lE-03-0 . 6537 1760339E-03-0 . 49993 1 59369E-02  0 . 8839335634 lE-02 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH? 

-0 . 1 3052 1 1 7389E+00-0 . 56787568869E+00  0.85331 3086 19E+00  0 . 32569793558E-0 1 
0.14170672412E+00  0.30577277261E+00  0.39459312048E+00  0.25003117172E+01 

TIME,  RES  =  0.3044248994617925  -1.3769985707234866E-09 

3.9087956427152903E-08  9.5910831056714163E-08 
TIME,  RES  =  0.3049206779855004  -1.1810167219183931E-09 

3 . 0781 5488653773 17E-08  9 . 59654 16238574797E-08 
TIME,  RES  =  0.3054164565092082  -7.3901854774627296E-10 

1 .8631565068538691E-08  9 .7980299972391660E-08 
TIME,  RES  =  0.3059122350329161  -4.8075224357013724E-11 

2. 625526462907 1462E-09  1 .0195451080954876E-07 

ITERATION  2 

STATE  CORRECTIONS 

-0.10722150156E-07-0.61757075247E-07-0.21764904283E-07  0.16577100941E-05 
0.70343076176E-05  0,73719177348E“05-0.64079980228E-02  0.22155013272E-01 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH? 

-0 . 130521 18462E+00-0 . 56787575045E+00  0 . 85331 306442E+00  0 . 32571451268E-01 
0.14171375842E+00  0. 305780 14452E+00  0.38818512246E+00  0,25224667305E+01 


LAST  PASS  RESIDUALS? 

TIME,  RES  =  0.3044248994617925  8.4121458791830417E-09 

-2 . 8659860962232386E-07  -2 . 41 10829931547895E-08 

TIME,  RES  =  0.3049206779855004  8.1024207794488934E-09 

-2 . 7763874843600433E-07  -2 . 2472149219590620E-08 

TIME,  RES  =  0.3054164565092082  8.4841813643987685E-09 

-2.7960959858575052E-07  -1 .5227996991856729E-08 

TIME,  RES  =  0.3059122350329161  9.5627215243587749E-09 

-2 . 9249940558528920E-07  -2 . 405271 7300521 165E-09 

CONVERGENCE  ACHIEVED. 

IN  NOMINIA  6AUSSIAM  TRAJECTORUM  REFERENTIA 
DECLARIUM  EST  ESTIMATIA 


COVARIANCE  MATRIX  AT  EPOCH  IS? 

0.8404415E-10  0.1046792E-09  0.1566623E-09  0,9782895E-09  0.9452315E-09 
0 .2142694E-08  0 . 3587019E-06-0 . 1220101E-05 

0,1046792E-09  0,4756074E-09-0.3150754E-10  0.1228656E-08  0.5207403E-08 


0.3311706E-08  0. 1479958E-05-0.4985&91E-05 


0.1566623E- 

-0.1320008E- 

0.9782895E- 

0.1426529E- 

0.9452315E- 

0.5069144E- 

0.2142694E- 

0.2970239E- 

0.3587019E- 

0.7838473E- 

-0.1220101E- 

-0.2612807E- 


■09-0.3150754E-10 

-07-0.4038229E-05 

-09  0.1228656E-08 
-06  0. 32221 62E-04- 

-09  0.5207403E-08- 
-06  0.1393375E-03- 

-08  0.3311706E-08- 
-05  0.7838473E-03- 

-06  0.1479958E-05- 
-03  0.2235445E+00- 

-05-0.4985691E-05 

-02-0.7462317E+00 


0 .5729318E-09  0 . 1038621E-08-0 .425341 lE-08 
0.1337189E-04 

0.1038621E-08  0.2041692E-07  0.4511387E-07 
-0.1074953E-03 

-0. 425341 lE-08  0.45113B7E-07  0.2394786E-06 
■0.4637291E-03 

-0.1320008E-07  0.1426529E-06  0,5069144E-06 
-0.2612807E-02 

•0.4038229E-05  0.3222162E-04  0. 1393375E-03 
■0. 746231 7E+00 

0 . 1337189E-04~0 . 1074953E-03-0 . 4637291E-03 
0.2491207E+01 


BEGIN  NEXT  BAYES  LOOP 

FIRST  PASS  residuals: 

TIME,  RES  =  0.3292138256471854  9.4314746735060795E-07 

-1 .2943698279 199722E-05  6.3898140858532904E-06 

TIME,  RES  =  0.3297096041708932  9.8383889319056395E-07 

-1.3462169187739015E-05  6.6381631998145563E-06 

TIME,  RES  =  0.3302053926946011  1 .025482 1639389677E-06 

- 1 . 3990683 1 36455573E-05  6 . 8907373141097877E-06 

TIME,  RES  =  0.3307011612183089  1 .068082335031 0564E-06 

- 1 , 45292 1 564493 1 703E-05  7.1 475083086563335E-06 


I  i 


*  w  * 

w“  OV"  • 

h  ^ " 

V 

L  .  .< 


L.  .,J 


SIGMA  IN-TRACK  =  0.1698133676908E-04 


ITERATION  1 

STATE  CORRECTIONS 

0.27972112873E-06  0.1 185621 16B4E-05  0.23853424221E-05  0.21854126474E-04 
0.94742438272E-04  0.20103919090E-03-0.75466819814E-02  0.28044354669E-01 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH’. 

-0 . 1 2963604088E+00-0 . 56402464814E+00  0 . 861 02694857E+00  0 . 38948223690E-0 1 
0.16945776838E+00  0.31689061533E+00  0.3806384404BE+00  0.25505110851E+01 

TIME,  RES  *  0.3292138256471854  -1. 4932671 453526947E-09 

2.3197488274728784E-07  1 .4615210542322232E-07 

TIME,  RES  =  0.3297096041708932  -7.6457434827759130E-10 

2.1318060261510396E-07  1 .4535152987639466E-07 

TIME,  RES  =  0.3302053826946011  1.1339767978790771E-09 

1 .7785563821703931E-07  1 .5167300177441889E-07 
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TIME,  RES  =  0.3307011612183089  4. 20748030 16656226E-09 

1 .2606740895648727E-07  1 .6505748414059884E-07 

ITERftTION  2 

STATE  CORRECTIONS 

-0 . 82168866266E-07-0 . 34 1 10283260E-06-0 . 991 06226545E-07  0 . 85924030800E-05 
0 . 37625698392E-04  0.311 97374905E-04-0 . 1 96581 00071 E-01  0 . 651 18972776E-01 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH! 

-0 . 12963612305E+00-0 . 56402498924E+00  0 . 86102684947E+00  0 . 38956816093E-01 
0.16949539408E+00  0.31692181271E+00  0.36098034041E400  0.26156300579E+01 


LAST  PASS  residuals: 

TIME,  RES  =  0.3292138256471854  3.5976612109550610E-08 

-1.5260417348672561E-06  -5.7668950975350852E-07 

TIME,  RES  =  0.3297096041708932  3.3442340712647178E-08 

-1.4513473045596470E-06  -5.6212877703500086E-07 

TIME,  RES  =  0.3302053826946011  3. 391 273609501 5328E-08 

-1.4196123973020391E-06  -5.2894433401513841E-07 

TIME,  RES  =  0.3307011612183089  3.7401526525177031E-08 

- 1 . 4306708795430723E-06  -4 . 772858130022011 9E-07 

CONVERGENCE  ACHIEVED. 

IN  NOMINIA  GAUSSIAM  TRAJECTORUM  REFERENTIA 
DECLARIUM  EST  ESTIMATIA 


COVARIANCE  MATRIX  AT  EPOCH  IS! 

0.1102327E-09  0.1219909E-09  0.1826780E-09  0. 1045043E-08  0.7809590E-09 
0,2183810E-08  0.3359626E-06-0.1093054E-05 

0.1219909E-09  0.5189815E-09-0.4896147E-10  0. 1148637E-08  0.4579112E-08 
0 , 4058759E-08  0 . 1420575E-05-0 . 4582128E-05 

0 . 1 826780E-09-0 . 4896 1 47E- 1 0  0 . 5692690E-09  0 . 1 257320E-08-0 . 32 1 3920E-08 
-0 . 99281 16E-08-0 . 2504 129E-05  0 . 7953704E-05 

0.1045043E-08  0. 1148637E-08  0.1257320E-08  0.1497127E-07  0.2603512E-07 
0 .8166362E-07  0 . 1355449E-04-0 . 4332920E-04 

0.7809590E-09  0.4579112E-08-0.3213920E-08  0.2603512E-07  0. 1472820E-06 
0 .2734220E-06  0 . 5856985E-04-0 . 1865572E-03 

0.2183810E-08  0.4058759E-08-0. 99281 16E-08  0.8166362E-07  0.2734220E-06 
0.2177873E-05  0.4662139E-03-0.1490733E-02 

0.3359626E-06  0. 1420575E-05-0.2504129E-05  0. 1355449E-04  0.5856985E-04 
0.4662139E-03  0. 1087214E+00-0.3482129E+00 

-0 . 1093054E-05-0 . 4582128E-05  0 .7953704E-05-0 . 4332920E-04-0 . 1865572E-03 


-0 . 1490733E-02-0 . 3482129E+00  0.11 15322E+01 


BEGIN  NEXT  BAYES  LOOP 

FIRST  PASS  residuals: 

TIME,  RES  =  0.3540027518325782  3.8237004408234188E-0& 

-4.6762177792314397E-05  2.0033971476651757E-05 

TIME,  RES  =  0.3544985303562861  3.985101B575828845E-06 

-4 . 8597633466096468E-05  2 . 0796713370265646E-05 

TIME,  RES  =  0.3549943088799939  4.1499881605275291E-06 

-5 . 0465553836698263E-05  2 . 1 570634670231570E-05 

TIME,  RES  =  0.3554900874037018  4.3183636609274434E-06 

-5. 2365679809 152077E-05  2 . 2355588841723589E-05 

SIGMA  IN-TRACK  =  0.1702700949043E-04 


ITERATION  1 
STATE  CORRECTIONS 

0.11155019366E-05  0.48079306520E-05  0.84404828391E-05  0.84946458285E-04 
0 .3<s9 1 0375836E-03  0 . 71 775738745E-03-0 . 167501 67522E-0 1  0 . 62508721764E-01 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH t 

-0 . 1 2858446292E+00-0 .55944941650E+00  0 .86903922680E+00  0 . 4601 1654338E-01 
0.20018941065E+00  0.32992905303E400  0.34423017288E+00  0.26781387797E+01 

TIME  RES  =  0.3540027518325782  -1.0538139388893697E-09 

1.1/  33473923580817E-06  1 .0304824417627090E-06 
TIME,  RES  =  0.3544985303562861  -1 .3554804639825946E-09 

1 . 1 3 1098340 1 558470E-06  9.91 00732980222928E-07 
TIME,  RES  =  0.3549943088799939  2.3037559256089413E-09 

1 . 042263387707 1 874E-06  9 . 6956349003238240E-07 
TIME,  RES  =  0.3554900874037018  9.9262575867231639E-09 

9,01 23382978646305E-07  9 . 6592378882182084E-07 

ITERATION  2 

STATE  CORRECTIONS 

-0.30380210858E-06-0.12720010757E-05-0,32951563698E-06  0. 3426681 11B5E-04 
0.14974583161E-03  0.11659816859E-03-0.52112881354E-01  0.16795677124E+00 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH! 

-0 . 12858476673E+00-0 . 55945068850E+00  0 .86903889728E+00  0 . 46045921 149E-01 
0.20033915648E+00  0.33004565120E400  0.29211729153E+00  0.28460955509E+01 

TIME,  RES  =  0.3540027518325782  1.6746894476032947E-07 

-5. 083070862443861 4E-06  -1 .8168623209247059E-06 

TIME,  RES  =  0.3544985303562861  1 .5290666578737788E-07 

-4.7781481982145380E-06  -1 .7856776209392022E-06 

TIME,  RES  =  0.3549943088799939  1 .50500858497881 75E-07 


_•  ••  •  -  -  *.  ^  v*  •  •v  ^  ^  -*V 


-4.6300409464183900E-06  -1 .6981500181346976E-06 

TIME,  RES  =  0.3554900874037018  1 . 6029546524853888E-07 

-4.6380109791632762E-06  -1 .5548145720113704E-0<i 

ITERftTION  3 

STATE  CORRECTIONS 

0 . 1 1027887499E-05  0 . 46573925932E-05-0.30154160647E-05-0 ,52401835723E-04 
-0 . 22961341017E-03  0 . 38702826215E-03  0 . 22374302593E+00-0 . 70853775081E+00 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH! 

-0. 1285836&394E+00-0 . 55944A031 lOE+00  0 .86903588187E+00  0 . 45993519314E-01 
0,20010954307E+00  0.33043267946E+00  0,5158603174&E+00  0.21375578001E+01 

TIME,  RES  =  0.3540027518325782  1.08884374987877A2E-06 

7 .36543 1 0890347574E-06  2 . 4609694936051502E-05 
TIME,  RES  =  0.3544985303562861  9.7812608919334298E-07 

8 . 01 6750 1843586564E-06  2 . 33636402548S4545E-05 
TIME,  RES  =  0.3549943088799939  8.6331014237037151E-07 

8.7128614700837659E-06  2.21 0058784508570 1 E-05 
TIME,  RES  =  0.3554900874037018  7.4442850427069995E-07 

9.4529556180500407E-06  2.0820903901052484E-05 

ITERATION  4 

STATE  CORRECTIONS 

0.17854296430E-06  0.68933950704E-06  0.37699460971E-05-0.75230045922E-04 
-0.32858211961E-03-0.71744152115E-03-0.28857294861E-02-0.97102354481E-03 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH! 

-0.12858348539E+00-0.55944534176E+00  0.86903965181E+00  0.45918289268E-01 
0.19978096095E+00  0.32971523794E+00  0.51297458797E+00  0.21365867765E+01 

TIME,  RES  =  0.3540027518325782  -3,0560709356544646E-07 

1 .9661887642685727E-05  1 .2539695299733367E-05 
TIME,  RES  =  0.3544985303562861  -2.6422762321870463E-07 

1 .8525041924455365E-05  1 .2205944158995286E-05 

TIME,  RES  =  0.3549943088799939  -2.2529963636733208E-07 

1 .7423861 189858059E-05  1 . 1858214805635092E-05 
TIME,  RES  =  0.3554900874037018  -1. 88782 15958528788E-07 

1 .6357548388801213E-05  1 .1496854991552979E-05 

ITERATION  5 

STATE  CORRECTIONS 

0 . 1 5553053302E-08  0 . 56803735475E-08  0 . 38406773695E-08-0 . 1 6855692767E-06 
-0.74431832884E-06-0.83759312294E-06  0.19481566539E-03-0.63362450061E-03 

CURRENT  REFERENCE  TRAJECTORY  STATE  VECTOR  AT  EPOCH! 

-0 . 12858348384E+00-0 . 55944533608E+00  0. 86903965565E+00  0 . 4591812071 lE-01 
0.19978021663E+00  0.32971440034E400  0.51316940364E+00  0.21359531520E+01 
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LAST  PASS  RESIDUALS 


TIME,  RES  =  0.3540027518325782  -3.0705709947245752E-07 

1 .96962A7535285195E-05  1 .2543279857120393E-05 
TIME,  RES  =  0.3544985303562861  -2.6548113169974630E-07 

1 .8556387777368677E-05  1 .2210041075121081E-05 
TIME,  RES  =  0.3549943088799939  -2.2634733563495213E-07 

1.7452070571910561E-05  1.1 8628591 88770 114E-05 
TIME,  RES  =  0.3554900874037018  -1.8961456738769700E-07 

1 .6382517613378056E-05  1 . 1502082224362775E-05 

CONVERGENCE  ACHIEVED. 

IN  NOMINIA  GAUSSIAN  TRAJECTORUM  REFERENTIA 
DECLARIUM  EST  ESTIMATIA 


COVARIANCE  MATRIX  AT  EPOCH  IS: 

0.1393081E-09  0.1337093E-09  0.2154270E-09  0.1122440E-08  0.5803153E-09 
0 . 8654768E-09  0.11 28700E-07-0 . 4592820E-07 

0.1337093E-09  0.5314678E-09-0.3615734E-10  0.1045351E-08  0.3855200E-08 
-0 . 1046738E-08  0 . 5760669E-07-0 . 191831 lE-06 


0 .21 54270E-09-0 . 3615734E-10  0 . 5812739E-09  0 . 4992800E-09-0 . 6541382E-08 
-0 . 1 167997E-07-0 . 6695660E-06  0 . 1917969E-05 


0.1122440E-08  0. 1045351E-08  0.4992800E-09  0.2982616E-07  0.9261183E-07 
0 .2303867E-06  0 . 1 126963E-04-0 .3291302E-04 

0.5803153E-09  0.3855200E-08-0.6541382E-08  0.9261183E-07  0.4325458E-06 
0.9416867E-06  0.4916842E-04-0.1431688E-03 

0 .8654768E-09-0 . 1046738E-08-0 . 1 167997E-07  0 . 2303867E-06  0 . 9416867E-06 
0 . 2644483E-05  0 . 1335936E-03-0 . 3894283E-03 

0.1128700E-07  0.5760669E-07-0.6695660E-06  0.1126963E-04  0.4916842E-04 
0 . 1 335936E-03  0 . 7 137864E-02-0 . 2088942E-01 


-0.4592820E-07-0.1918311E-06  0.1917969E-05-0.3291302E-04-0. 1431688E-03 
-0 . 3894283E-03-0 . 2088942E-01  0 . 61 16383E-01 


BEGIN  NEXT  BAYES  LOOP 
FIRST  PASS  residuals: 

TIME,  RES  =  0.3787916780179711  -1.8083123288006875E-07 

-1.0493742894412961E-05  -1 .4617415061 105032E-05 

TIME,  RES  =  0.3792874565416789  -1 .9064246669156515E-07 

- 1 . 0928857187009200E-05  - 1 . 5242471579000189E-05 

TIME,  RES  =  0.3797832350653868  -1 .9951272854992763E-07 

-1.1 374361 1 5095091 8E-05  -1 . 5865443922489370E-05 

TIME,  RES  =  0.3802790135890946  -2.0734194169230724E-07 
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